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AFIT/GE/ENG/85D-21 


Abstract 


A  robust  controller  for  the  STOL  F-15  aircraft  is 
developed  using  the  LQG/LTR  (linear  system  model,  quadratic 
cost,  gaussian  models  of  uncertainty  used  for  controller 
synthesis,  with  loop  transfer  recovery  techniques  of  tuning 
the  filter  in  the  loop  for  control  robustness  enhancement) 
methods.  Full  state  feedback  controllers  are  synthesized 
using  CGT/PI  (Command  Generator  Tracking  feedforward 
compensator  to  provide  direct  incorporation  of  flying  quali¬ 
ties  into  the  design  process,  with  proportional  plus  inte¬ 
gral  feedback  control)  synthesis,  using  implicit  model  follow 
ing  techniques  to  improve  full  state  robustness  character¬ 
istics.  Finally,  a  Kalman  filter  is  used  to  replace  the 
unrealistic  assumption  of  full  state  availability  with  esti¬ 
mated  states,  using  a  LTR  scheme  to  recover  as  much  full 
state  robustness  characteristics  as  possible. 
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AN  LQG  UP-AND-AWAY  FLIGHT  CONTROL  DESIGN 
FOR  THE  STOL  F-15  AIRCRAFT 

I .  Introduction 

1 . 1  Background 

The  initial  approach  used  to  design  aircraft  con¬ 
trol  systems  involved  a  mixture  of  classical  single-input/ 
single-output  (SISO)  control  design  techniques  and  engi¬ 
neering  insight.  In  the  past  this  has  been  effective, 
providing  that  the  designer  had  sufficient  intuition  and 
was  willing  to  carry  the  design  process  through  enough 
single  loop  iterations  to  meet  specifications.  However,  as 
airframes  became  more  complex  and  control  surfaces  more 
numerous,  this  method  became  unwieldy,  creating  a  need  for 
multiple- input /multiple-output  (MIMO)  controller  synthesis 
techniques.  One  school  of  thought  emerging  from  this  need 
is  the  extension  of  classical  techniques  to  the  MIMO  case, 
thereby  taking  advantage  of  frequency  domain  theory  devel¬ 
oped  by  Bode,  Nyquist,  and  Hurwitz  (24).  A  second  approach 
to  MIMO  controller  design  involves  time  domain  techniques, 
which,  assuming  that  the  plant  can  be  modeled  as  linear, 
can  be  readily  coupled  with  linear  system  theory  to  yield 
a  procedure  which  can  be  implemented  on  digital  computers. 
Although  both  of  the  previously  mentioned  MIMO  design 
philosophies  have  adamant  supporters,  they  are  really  two 


sides  of  the  same  coin,  so  neither  should  be  abandoned  for 
the  other. 

A  design  method  which  incorporates  both  the  ease 
of  implementation  associated  with  time  domain  techniques 
and  the  invaluable  stability  information  obtained  from  fre¬ 
quency  domain  analysis  is  the  Linear-Quadratic-Gaussian 
(LQG)  (11;  12)  approach  coupled  with  Loop  Transfer  Recovery 
(LTR)  (5;  9;  13;  22).  A  more  specific  formulation  using 
LQG  synthesis  methods,  which  is  especially  attractive  for 
flight  control  applications,  is  Command  Generator  Tracking 
(CGT)  combined  with  a  regulator  (R)  designed  via  LQG 
methods;  this  is  often  denoted  as  a  CGT/R  design  (12:151- 
166) .  This  method  yields  a  controller  capable  of  incor¬ 
porating  handling  qualities  directly  into  the  design  pro¬ 
cess,  while  rejecting  specified  disturbance  inputs.  A 
more  useful  formulation  of  the  CGT  technique  would  include 
a  proportional  plus  integral  (PI)  controller  in  a  closed 
loop  law  incorporating  a  CGT  precompensator  in  order  to 
achieve  type  1  characteristics;  this  is  designated  as  a 
CGT/PI  controller.  However,  as  will  be  discussed  later, 
problems  have  been  encountered  in  the  design  of  the  full 
CGT/PI  controller  when  a  filter  is  embedded  in  the  control 
loop  and  LTR  techniques  are  applied  to  achieve  a  robust 
controller.  Therefore,  in  some  applications,  CGT/R  and 
CGT/PI  designs  might  both  be  pursued  by  means  of  LQG/LTR 
techniques. 


1.2 


Problem 


The  objective  in  this  study  is  to  design  a  robust 
tracker  controller  for  the  STOL  F-15  aircraft  using  digital 
Command  Generator  Tracking  to  incorporate  specified  air¬ 
craft  handling  qualities  into  the  design  process.  This 
controller  will  be  designed  via  LQ  methods  using  implicit 
model  following  to  enhance  robustness  (16).  Kalman  filter¬ 
ing  techniques  will  be  used  to  replace  full  state  feedback 
with  state  estimates.  The  robust  tracker  controller  will 
be  designed  to  maintain  aircraft  stability  (and  as  desirable 
performance  as  possible)  in  the  face  of  large  parameter 
variations  such  as  control  actuator  failure,  mismodeled 
actuator  dynamics,  and  actuator  saturations.  This  study 
will  also  address  the  robustness  degradation  due  to  reducing 
the  order  of  the  aircraft  model  and  also  due  to  operating 
the  aircraft  at  a  different  point  in  its  operational 
envelope  than  that  used  for  controller  design.  The  feasi¬ 
bility  of  using  the  LTR  tuning  method  developed  by  Doyle 
and  Stein  (5;  22)  in  a  CGT/PI  controller  will  also  be 
investigated. 

It  is  not  an  objective  of  this  thesis  to  engage  in 
a  debate  over  the  adequacy  of  existing  MIMO  controller 
synthesis  techniques;  however,  several  methods  of  address¬ 
ing  the  same  STOL  F-15  problem  will  be  carried  out  concur¬ 
rently  with  this  study  (1;  20) ,  in  the  hope  that  a 
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comparison  of  the  obtained  results  will  prove  useful  in 
constructing  logical  approaches  to  similar  problems. 

1.3  Scope 

This  thesis  effort  will  encompass  the  LQG/LTR 
design  and  analysis  of  a  CGT/PI/KF  longitudinal  flight  con¬ 
trol  system  for  the  STOL  F-15  aircraft.  Specifically,  the 
added  aerodynamic  surfaces  of  the  STOL  version  of  the  F-15 
are  exploited  to  accomplish  a  pitch  pointing  maneuver  at 
4  points  within  the  aircraft's  combat  envelope.  Further, 
a  complete  robustness  enhancement/analysis  of  the  controller 
designed  at  the  "nominal”  flight  condition  of  Mach  0.9  at 
20,000  feet  will  be  carried  out.  Such  topics  as  plant 
variations,  control  derivative  variations,  noise  corruption 
of  plant  states,  throttle  gain  scheduling,  control  surface 
failures,  measurement  noise  corruption,  and  impact  of  LTR 
tuning  on  a  PI  controller  design  will  be  addressed.  A 
nonlinear  analysis  of  the  controller  design,  specifically 
admitting  both  position  and  rate  limit  saturations  of 
actuators,  will  be  carried  out  using  Monte  Carlo  analysis 
software  designed  as  a  part  of  this  thesis  effort. 

1.4  Assumptions 

The  physical  description  of  an  aircraft's  dynamics 
can  be  represented  by  a  set  of  nonlinear  differential  equa¬ 
tions.  Although  these  equations  present  a  very  accurate 
portrayal  of  the  true  aircraft,  they  fail  to  be  useful  in 


designing  control  systems  due  to  the  tremendous  computa¬ 
tional  loading  incurred  for  a  relatively  small  improvement 
in  performance  compared  to  controllers  based  on  linearized 
aircraft  equations  of  motion.  Therefore,  for  the  purposes 
of  the  designs  accomplished  in  this  study,  perturbation 
equations,  linearized  about  specific  trim  conditions,  will 
be  assumed  adequate  for  the  design  models  representing  the 
STOL  F-15  aircraft' s  equations  of  motion.  A  further  assump¬ 
tion  which  will  be  made  is  that  all  noise  corruptions  in 
both  the  system  and  measurement  models  will  be  adequately 
modeled  as  white  and  Gaussian.  Although  a  true  white  noise 
would  contain  infinite  power,  the  assumption  of  white  noise 
physically  implies  that  colored,  i.e.  time  correlated, 
noises  affecting  the  system  will  appear  white  over  the 
bandpass  of  interest  in  the  aircraft  dynamics  (11) .  The 
assumption  of  Gaussianess  can  be  justified  by  invoking  the 
central  limit  theorem  of  probability  theory  (11;  18) .  The 
above  mentioned  assumptions  are  considered  major  in  that 
they  are  a  significant  influence  on  the  entire  thesis. 

Other  assumptions  made  throughout  the  remainder  of  this 
study  are  of  less  global  impact;  therefore,  these  will  be 
presented  only  as  needed  for  specific  development.  Although 
wind  buffet  rejection  in  the  CGT  controller  is  not  addressed, 
this  could  be  accomplished,  if  desired,  using  the  same 
methodology. 


1.5  Sequence  of  Presentation 

The  material  contained  in  this  thesis  is  presented 
in  such  a  manner  as  first  to  build  a  theoretical  framework 
and  then  to  use  the  developed  control  synthesis  techniques 
in  a  specific  application.  Chapter  II  presents  CGT/R  and 
CGT/PI  controller  forms  and  discusses  the  advantages  and 
disadvantages  of  each.  Chapter  III  introduces  the  equa¬ 
tions  of  motion  and  the  model  for  the  STOL  F-15  aircraft. 
Chapter  IV  is  concerned  with  stability  and  robustness 
enhancement  of  the  controllers  discussed  in  Chapter  II. 
Chapter  V  is  the  culmination  of  the  preceding  three  chap¬ 
ters;  in  this  chapter  controller  designs  are  carried  out 
and  evaluated  using  existing  and  designed  computer  aided 
design  software  (7;  16;  17).  Finally,  Chapter  VI  presents 
conclusions  of  the  research  conducted  and  recommendations 


for  further  study. 


2.1 


Introduction 


This  chapter  is  intended  to  serve  as  an  introduc¬ 
tion  to  the  theoretical  foundation  upon  which  the  controller 
design  of  Chapter  V  is  based.  It  is  assumed  that  the 
reader  has  had  an  upper  division  undergraduate  or  a  first 
year  graduate  level  course  in  classical  control  theory  (4) 
and  has  a  knowledge  of  modern  optimal  control  which  includes 
basic  LQG  techniques  and  Kalman  filtering  (11;  13) .  Any 
further  material  considered  substantive  to  a  full  under¬ 
standing  of  Chapter  V  will  be  presented  herein. 

The  remaining  sections  contained  in  this  chapter 
develop  four  interrelated  concepts.  First,  a  derivation  of 
LQG  regulators  will  be  presented.  Shortcomings  of  this 
form  of  controller  will  be  discussed  as  a  motivation  for  the 
subsequent  section  on  proportional  plus  integral  controllers 
designed  via  LQG  methods.  Section  2.4  is  intended  to  give 
the  reader  a  conceptual  introduction  to  model  following 
design  techniques.  Thus,  it  yields  a  coherent  transition 
into  Section  2.5  which  introduces  Command  Generator  Track¬ 
ing  theory  and  its  closed  loop  application  with  both 
regulator  and  PI  controller  forms. 

As  a  final  statement  before  embarking  on  the  theo¬ 
retical  sections  of  this  chapter,  the  reader  should  be 


aware  that  the  following  derivations,  although  functionally 
complete,  are  not  intended  to  be  mathematically  rigorous. 
Those  who  desire  more  theoretical  detail  are  directed  to 
References  11  and  12.  However,  this  thesis  is  directed 
toward  engineering  application,  and  consequently  deriva¬ 
tions  will  be  intended  for  the  practicing  engineer. 


2 . 2  Synthesis  of  LQG  Regulators 

This  section  presents  regulator  design  via  LQG 
synthesis  techniques.  The  following  derivation  is  taken 
primarily  from  Reference  13  with  exceptions  as  noted. 

Consider  the  linear,  discrete  time,  vector  valued, 
stochastic  difference  equation 


*(ti+l>  =±<ti+rtiU<ti)  +Bd(t±)u(ti)  +Gd(ti)wdlt.) 


(2-1) 


where 


x  is  an  n-dimensional  state  vector, 

is  an  nxn  state  transition  matrix, 

u  is  an  r-dimensional  control  deterministic  control 
input, 

B  is  an  nxr  input  matrix,  and 

w^  is  a  discrete-time  Gaussian  noise  sequence 
completely  characterized  by 

E{wd(t.) }  =  0  (2-2) 


and 


E{wd(ti)w^(tj)}  = 


Qd 


ID 


(2-3) 
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•  *'n  *  <  *  «  ■'* 


-r, 


where  is  the  covariance  of  the  noise  sequence,  and  <5^_. 
is  the  Kronecker  delta  function. 

Although  a  discrete  system  of  the  above  form  could 
arise  naturally,  in  flight  control  applications,  and  many 
other  applications  as  well,  this  model  would  be  an  equiva¬ 
lent  discrete -time  representation  for  an  underlying  continu¬ 
ous  system  (11:133,192).  A  stochastic  differential  equa¬ 
tion  which  could  be  used  to  describe  such  an  underlying 
continuous  system  would  be 

x(t)  =  F  (t)  x  (t)  +  B(t)u(t)  +  G  (t)  w(t)  (2-4) 

where  w(t)  is  zero-mean  white  Gaussian  noise  with  a  covari¬ 
ance 

E{w(t)wT(t+t)  }  »  Q6  (t)  (2-5) 


where  <5(t)  is  the  Dirac  delta  function. 

The  discrete-time  input  matrix  and  the  noise 
strength  of  Equation  (2-1)  can  be  derived  from  the 
underlying  continuous  system  model  parameters  by  the  rela¬ 
tions  (11)  : 


For  the  LQG  regulator  it  is  desired  that  certain 
linear  combinations  of  the  state  variables,  designated 
control  variables,  be  regulated  to  zero.  In  the  case  of 
flight  controller  design,  linearized  models  are  used,  and 
the  perturbation  control  variables  are  linear  combinations 
of  perturbation  states;  regulating  these  perturbation 
variables  to  zero  is  equivalent  to  driving  the  aircraft 
back  to  the  specific  trim  condition  used  for  the  basis  of 
the  linearized  equations  (6:154,165).  These  variables  are 
represented  by  the  p-dimensional  vector  yc  defined  by 

^(t)  =  C  (t)x(t)  (2-8) 

where  C  is  a  pxn  output  matrix.  A  direct  transmission 
term  (D(t)u(t))  in  equation  (2-8)  would  create  cross¬ 
coupling  between  the  states  and  the  control  inputs  in  the 
quadratic  cost  function;  however,  no  generality  is  lost 
due  to  the  omission  of  this  term,  as  will  be  shown  subse¬ 
quently. 

As  an  initial  attempt  to  produce  an  optimal  control 
function  u(t) ,  consider  minimization  of  a  cost  function  of 
the  form 

J  =  E  1  £  i(£[(t.)Y(t.  W  (t.)  +  uT(t.)U(t.)u(t.)  ) 

c  1  ici  i  i  i 

+  2,^c(tN+l)-ficltN+l))j 


(2-9) 


where  Y(t^)  and  Y^  are  pxp  symmetric  weighting  matrices  on 

the  control  variables  at  time  t.  and  the  final  time  t£, 

1  f 

respectively.  These  matrices  are  both  chosen  to  be  posi¬ 
tive  definite  under  the  assumption  that  there  should  exist 
a  cost  associated  with  any  control  variable  deviation  from 
zero,  or  deviation  from  trim  conditions  for  aircraft  per¬ 
turbation  variables.  U(t^)  is  an  rxr  symmetric  positive 
definite  weighting  matrix  on  the  control  inputs;  in  this 
case  the  weighting  is  chosen  positive  definite  in  order  to 
avoid  a  controller  which  attempts  to  expend  infinite  con¬ 
trol  energy. 

The  magnitudes  of  Y  and  U  are  chosen  relative  to 
one  another.  If  Y  is  chosen  larger,  tighter  control  of 
the  state  trajectories  is  achieved.  If  U  is  chosen  larger, 
less  control  "energy"  can  be  expended. 

The  cost  minimizing  control  function  u* (t^)  can  be 
shown  to  be  a  linear  function  of  the  system  states 

uMt^  =  -G*(t±)x(ti)  (2-10 

Note  that  Equation  (2-10)  makes  the  unrealistic  assumption 
that  all  of  the  system  state  variables  will  be  accessible. 

A  more  practical  assumption  would  incorporate  a  measurement 
model  consisting  of  incomplete,  noise  corrupted  measure¬ 
ments  as  follows  (11:203,225): 


In  the  above  equation  v(t^)  is  a  zero-mean  Gaussian 
m-dimensional  noise  sequence  with  covariance  R(t^)  and  H 
is  an  mxn  measurement  matrix.  It  is  assumed  that  v  is 
independent  of  the  discrete  dynamics  model  noise  wd(t^) 
of  Equation  (2-1)  (11:203,225). 

In  light  of  Equation  (2-11) ,  the  optimal  control 
function  described  by  Equation  (2-10)  would  seem  to  be 
little  more  than  a  mathematical  abstraction,  void  of  any 
practical  engineering  application;  however,  this  is  not 
the  case.  Under  the  LQG  assumptions,  certainty  equivalence 
may  be  invoked  (12:24,45);  thus,  the  optimal  control  feed¬ 
back  weighting  matrix,  G£,  for  a  nondeterministic  system 
with  only  partial,  noise-corrupted  state  measurements 
available,  can  be  derived  under  the  assumption  of  a  deter¬ 
ministic  system  model  with  access  to  all  states.  Once 
derived,  this  optimal  gain  may  be  cascaded  with  a  Kalman 
filter  in  order  to  produce  an  optimal  stochastic  control 
of  the  following  form: 

u*(ti)  =  -G*(t±)x(td)  (2-12) 

The  optimal  gain  function,  u*,  can  be  obtained  by 
solving  for  the  optimal  gain  G£  (t^  as  a  function  of  the 
backward  Riccati  recursion  difference  equation  for  the 


matrix  K  : 


Id 


r 


GJ<t.|  =  mtL)  +BT(t.)Kc(ti+1)BJ(ti>)-1 

•  (SdT(ti)So|ti+i|i|ti+rt1,)  (2-13» 

where 

W  -  2'V  +-iT(ti+i'ti,2o(titi) 

•  l2-14) 

(Note  that  Kc  has  been  constructed  in  order  to  provide 
tractability  in  the  solution  for  the  optimal  gain  matrix 
and  bears  no  relation  to  the  Kalman  filtering  gain  K. ) 

Since  Equation  (2-14)  is  a  backward  running  equa¬ 
tion,  the  solution  must  be  generated  from  a  terminal  con¬ 
dition  defined  as 

-c(tN+l}  =  -f  =  CT(tf)YfC(tf)  (2-15) 

This  completes  the  formulation  of  the  simple  LQG  regulator; 
however,  an  important  problem  which  has  not  yet  been 
addressed  is  the  need  to  exert  effective  sample  data  con¬ 
trol  over  a  continuous  system,  not  only  at  each  sample 
time,  but  between  sample  times  as  well. 

Consider  a  flight  control  application  in  which  a 
digital  controller  is  implemented  to  maintain  stable  flight 
in  a  statically  unstable  flight  mode.  If  the  sampling  rate 
of  the  controller  is  less  than  approximately  five  times 
the  Nyquist  rate,  the  aircraft  could  go  unstable  between 
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sample  times.  For  flight  controller  design,  the  initial 
and  terminal  transients  of  an  LQG  controller  for  a  time- 
invariant  system  subjected  to  stationary  noises,  and 
designed  using  constant  weighting  matrices,  can  be  con¬ 
sidered  negligible  in  comparison  to  the  length  of  time  that 
the  aircraft  is  in  steady  state  conditions.  Consequently, 
the  controller  gains  g£  matrices  (as  well  as  any  Kalman 
filter  gains  which  might  be  associated  with  the  system) 
become  constants. 

An  appropriate  quadratic  cost  function  which 
incorporates  a  continuous  weighting  of  the  system  states 
and  control  inputs  is 

ilT  ^  I*  i+1  ]  T 

(t^JXfXdW  +J0(J  i(xT(t)Wxx(t)x(t) 

+  uT<t)Wuu(t)u(t)  +  2xT(t)Wxuu(t)  )dt)J  (2-16) 

where  W  (t)  is  positive  semidef inite ,  so  some  states  may 

not  have  a  cost  associated  with  them  if  desired,  and  W  (t) 

— uu 

is  positive  definite  for  all  t  for  the  same  reason  as  dis¬ 
cussed  for  U(t^) .  Upon  dividing  this  function  into  n+1 
control  intervals  over  the  cost  function 

becomes 

Jc  =  Ejl2T(Vl^f2'Vl>  +  \  itxT(t  )x(t  )x(ti) 

(  1=0 


where 


fti+1  T 

X(t±)  =  J  4(t(t.)Wxx(t)  $(t,ti)dt 


(2-18) 


r  i+l  _T 

U(ti)  =  J  [B1  (t,ti)WxX(t)B(t,ti)  +Wuu(t) 
tx 

+  IT(t,ti)Wxu(t)  +WxuB(t,t±)]dt  (2-19) 


S(ti)  -  J 


'i+l 


[$T(t>t.)Wxx(t)B(t,t.)+$T(t,ti)Wxu(t)]dt 

(2-20) 


and  t 

B(t,ti)  =  J  0(t,T)B(x)dT 


(2-21) 


t . 
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Thus  the  desire  to  exert  control  between  sample 
times  has  generated  cross  terms  in  the  discrete  quadratic 
cost  function.  Heuristically ,  Equation  (2-20)  can  be 
interpreted  as  an  indication  of  how  coupling  between  the 
states  and  the  control  inputs  can  arise  in  the  cost  func¬ 
tion.  The  second  term  on  the  right  side  of  Equation  (2-20) 
is  a  function  of  Wxu,  which  arises  from  natural  coupling 
between  x  and  u  in  the  continuous- time  setting,  such  as  the 
desire  to  control  a  deflection  rate  of  a  control  surface, 
yielding  a  desire  to  put  a  quadratic  weighting  on  the 
derivative  of  the  system  state  vector  x(t).  The  first  term 


£ 


e 


i 


on  the  right  side  of  Equation  (2-20)  is  a  function  of  W  ; 

XX 

this  indicates  that  a  cross  coupling  in  the  discrete  cost 
function  can  be  generated  by  the  desire  to  exert  control 
between  the  sample  times  even  if  no  natural  coupling  exists 
in  the  continuous -time  system. 

The  previous  discussion  motivates  the  need  for 
cross  coupling  terms  in  the  discrete  quadratic  cost  func¬ 
tion  associated  with  the  LQG  regulator.  Since  this  cross 
coupling  exists,  there  is  no  need  to  extend  Equation  (2-8) 
to  include  a  direct  transmission  term  as  this  would  not 
modify  the  Equation  (2-16)  (see  page  81,  Reference  12, 
for  a  more  detailed  treatment  of  cross  coupling  as  a  con¬ 
sequence  of  a  direct  feedthrough  of  the  control  input) . 

The  optimal  gain  matrix  Equations  (2-13)  and  (2-14) 
can  be  modified  to  account  for  the  addition  of  cross 
coupling  terms  between  x  and  u  in  the  following  manner: 

SS'V  ”  <«<V  +Bd'Sti)Kc<ti+i>Bd(t.))-1 

•  (B,  ( t .  Fk  (t.il)4(t..1,t.)  tsSt.))  (2-22) 

— d  i  — c  l+l  —  l+l  i  —  l  ' 


where  K  is  now  defined  as  the  solution  to: 
— c 


KC<V  -  2<V  +*<ti+1.ti>Kc(ti+l>»<ti+1-ti) 

(2-23) 
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The  LQG  stochastic  regulator  described  in  this 
section  has  been  shown  to  possess  desirable  qualities  such 
as  providing  control  between  sample  times  and  allowing  full 
state  feedback  to  be  replaced  with  Kalman  filter  estimates. 
However,  it  suffers  from  the  drawback  of  displaying  type 
zero  characteristics  (4:199-201).  The  desire  to  compensate 
for  modeling  errors,  reject  constant  unmodeled  disturbances, 
and  achieve  zero  steady  state  tracking  error,  motivates  a 
design  which  displays  type  1  behavior.  Such  a  controller 
is  the  proportional  plus  integral  design  developed  in  Sec¬ 
tion  2.3. 

2.3  Synthesis  of  PI  Controllers 

via  LQG  Methods 

As  stated  in  the  previous  section,  the  desire  to 
obtain  a  controller  which  exhibits  type  1  characteristics 
motivates  investigation  of  proportional  plus  integral  forms. 
In  this  section  the  PI  controller  of  classical  control 
theory  is  derived  using  modern  methods  under  LQG  assump¬ 
tions.  The  application  of  LQG  synthesis  techniques  to  the 
design  of  PI  controllers  allows  for  systematic  extension 
from  SISO  to  MIMO  systems  (particularly  for  the  proper 
evaluation  of  cross-coupling  gains  in  a  MIMO  PI  controller) , 
and  therefore,  greater  flexibility  in  flight  control 
design  problems.  The  LQG  design  of  PI  controllers  is 
further  motivated  by  other  important  factors  such  as  itera¬ 
tive  design  capability,  ease  of  off-diagonal  weighting 


between  integral  and  proportional  channels,  stability  of 
LQ  designs,  and  robustness  enhancement  through  both  LTR  and 
implicit  model  following  techniques.  Again,  unless  stated 
otherwise  the  development  of  this  section  is  taken  from 
Reference  12. 

Before  embarking  on  the  mathematical  derivation  of 
the  PI  controller,  it  is  in  order  to  discuss  some  of  the 
motivations  for  implementing  this  particular  type  of  con¬ 
troller  structure.  Consider  a  controller  driven  by  an 
error  signal,  which  in  turn  generates  a  system  control 
input.  It  is  desirable  to  structure  this  controller  in 
such  a  manner  as  to  maintain  control  of  the  state  trajec¬ 
tories  of  the  system  even  in  the  event  that  the  input  to 
the  controller  itself  is  driven  to  zero  (13);  e.g. ,  if  the 
tracking  error  is  zero,  under  a  particular  set  of  equili¬ 
brium  conditions,  one  still  wants  the  controller  to  produce 
the  control  necessary  to  keep  the  system  at  that  desirable 
equilibrium  condition.  The  PI  structure  is  able  to  accom¬ 
plish  this  task  due  to  the  "integral  action"  which  is  not 
inherent  in  simple  regulator  schemes  (13) .  A  second  advan¬ 
tage  gained  by  PI  forms  over  simple  regulator  structures 
is  the  ability  to  reject  constant  unmodeled  disturbances, 
thereby  improving  steady  state  performance  of  the  system 
(13) .  A  conclusion  that  can  be  drawn  from  the  foregoing 
discussion  is  that,  while  not  absolutely  necessary  for 


wvr."r'iw  v 


flight  control  applications,  the  PI  controller  structure 
can  be  a  significant  improvement  over  simple  regulator 
forms. 

Consider  a  nominal  control  u  needed  to  hold  a 

— o 

deterministic  time  invariant  system  of  the  form 

x(ti+i)  =  $x(t±)  +Bdu(t±)  (2-24) 


in  an  equilibrium  condition.  The  nominal  control  could 

represent  the  control  necessary  to  maintain  an  aircraft  in 

a  specified  maneuver  or  trim  condition. 

From  the  above  definition  of  u  ,  the  nominal  state 

— o 

trajectory  xq  can  be  written  as 


x 

— o 


=  4>x  +  B.u 
— o  — d— o 


(2-25) 


and  a  desired  set  of  control  variables  are  defined  by 

^d  =  — 0  +  — y— o  <2-26> 

(Note  that  the  direct  feedthrough  matrix  is  explicitly 
included  here.  Because  the  derivation  of  the  PI  controller 
involves  more  than  just  a  simple  LQ  design,  this  term 
cannot  be  removed  from  Equation  (2-26)  by  embedding  it  in 
cost  function  cross  terms  as  was  done  in  the  derivation  of 
simple  regulator  forms.) 
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In  matrix  form,  Equations  (2-25)  and  (2-26)  become 


(2-27) 


This  matrix  equation  can  be  used  to  solve  the  xq  and  uq  by 


X 

*  -  1  B . 

-l 

0 

— o 

—  —  — d 

^o_ 

C  D 

L  -  -yj 

*d_ 

where  the  augmented  matrix  inverse  can  be  partitioned  as: 


#  -  i 

5d 

-i 

-ii 

-12 

c 

D 

-yj 

r21 

% 

(2-29) 


For  cases  where  the  matrix  on  the  left  side  of 
Equation  (2-29)  is  not  square,  pseudoinverse  techniques  may 
be  used  to  yield  a  solution  in  some  cases  (12:124;  22:142); 
however,  for  the  purposes  of  this  development  it  is  assumed 
that  the  number  of  controls  is  equal  to  the  number  of  con¬ 
trolled  outputs  and  that  the  matrix  in  question  is  in  fact 
invertible,  so  pseudoinverse  forms  will  not  be  needed. 

With  the  nominal  state  trajectory  and  control  defined  by 
Equation  (2-28) ,  it  is  now  possible  to  define  the  following 
set  of  perturbation  variables: 


(2-31) 


6u(t.)  =  u(t.)  -u^utt.)  =  n22*d 


and 

-^c'V  -io'V -la  (2~32> 

As  discussed  in  Section  2.2,  it  is  desired  to  regu¬ 
late  these  perturbation  variables  to  zero;  however,  it  is 
further  desired  that  this  be  accomplished  with  a  controller 
which  incorporates  integral  action  into  its  design.  The 
derivation  to  follow  will  develop  such  a  controller  based 
upon  pseudorates  (13) . 

The  difference  in  the  control  perturbation  state 
over,  jSu,  one  sample  time  can  be  expressed,  using  Equation 
(2-31) ,  as 

_Su(ti+i)  -  6u(t±)  =  (u(ti+1)  -  uq)  -  (uft^  -  uq)  (2-33) 

Therefore,  _6u(t^+1)  may  be  expressed  as 

<5u(tj|  i>  =  _6u  ( t^ )  +  <u(t.+1)  -  u(t±)  )  (2-34) 

where  the  second  term  on  the  right  side  of  Equation  (3-34) 
can  be  interpreted  as  an  Euler  or  tangent  line  integration 
(13:68,81)  as  shown  in  Equation  (2-35). 

Auft^)  =  (u(ti+1)  -u(ti)  )  =  Atu(ti)  (2-35) 
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From  Equations  (2-34)  and  (2-35)  j$u  may  be  defined 
as  a  new  state  variable  and  augmented  to  Equation  (2-24) 
to  form  the  new  state  space  model: 


j5x(ti+l) 

jH(ti+i> 


(2-36) 


where  the  pseu  )rate  6u  now  forms  the  control  input  to  the 


augmented  system  model. 

The  quadratic  cost  function  which  is  minimized  in 
order  to  yield  an  optimal  deterministic  control  for  the 
system  of  Equation  (2-36)  is 


+  1  — (tN+l)  -fll  -  — JtN+l* 

2  l^wj  L  -  tJ  L^w. 


(2-37) 


Note  that  the  lower  limit  on  the  summation  in 
Equation  (2-37)  starts  at  -1  instead  of  0.  This  change  in 
the  usual  quadratic  cost  notation  is  motivated  by  the  need 
to  control  the  initial  condition  of  the  system  in  order  to 
achieve  good  initial  transient  responses  through  placing  a 
weight  on  u(t_^)  (12:142).  The  term  in  Equation  (2-37) 


€ 
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provides  a  cost  weighting  on  the  state  trajectory  devia¬ 
tion  from  nominal  and  ^2  weights  control  magnitudes,  both 
of  which  could  have  been  accomplished  by  the  regulator 
formulation  of  the  previous  section.  However,  the  U  term 
is  a  weighting  on  control  differences,  which  under  the 
approximation  of  Equation  (2-35)  can  be  considered  a  weight¬ 
ing  on  control  rates.  The  cross  terms  X12,  — l'  anc*  ^2  Can 
arise  through  natural  coupling  or  through  discretization  of 
a  continuous  cost  function  as  discussed  in  the  simple  regu¬ 
lator  case  of  Section  2.2. 

Solving  for  the  optimal  control  function  based  upon 
Equation  (2-37) ,  and  restricting  attention  to  cost  func¬ 
tions  which  allow  the  terminal  time  to  approach  infinity; 
yields  a  constant  gain  feedback  control  law  of  the  form 


Au(ti) 


* 


Sxft^ 
6u (ti) 


(2-38) 


where  the  gains  G*.  and  G*~  can  be  solved  for  in  the  same 
manner  presented  in  Section  2.2. 

Although  Equation  (2-38)  represents  an  optimal 
perturbation  regulator  with  a  capability  to  regulate  both 
control  magnitudes  and  control  rates,  it  does  not  achieve 
the  desired  objective  of  attaining  type  1  system  response 
since  it  lacks  integral  action.  This  deficiency  will  now 
be  addressed. 
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The  desired  form  of  the  PI  controller  based  upon 
Equations  (2-35)  and  (2-38)  should  be  an  optimal  control 
signal  constructed  in  terms  of  the  system  perturbation 
states  of  the  following  form: 

^*(ti+l)  =  iu*(t±)  -  Kx(«x(ti+1)  -  6x(ti)) 

-K  (C  6x(t.)  +D  6u(t.))  (2-39) 

«  i  y  l 

where  K  and  K  are  constant  gain  matrices.  The  top  parti- 
X  z 

tion  of  Equation  (2-36)  can  be  written  as 

6x(ti+1)  =  6x(ti)  +  (i-I)6x(ti)  +  Bd6u(ti)  (2-40) 


Inserting  Equation  (2-40)  into  (2-39)  and  writing  in  matrix 
form  yields 


*  1-1  B,  6x(t  ) 

6u  (t.  ,)  -  6u*(t. )  = -(K  K  )  1  (2-41) 

11  1  X  Z  C  D,  6u(t.) 

—  — y  —  i 


By  setting  the  right  sides  of  Equations  (2-39)  and  (2-41) 
equal,  the  gains  K  and  K  may  be  evaluated  as 


-x  *  -cl  -11  +  — c 2  -21 


(2-42) 


=  «1  —12  +  — c2  "22 


(2-43) 


Thus,  once  G*  is  established,  K  and  K  may  be  computed. 
"  c  X  z 


24 


Under  the  assumption  that  is  piecewise  constant 
and  varies  slowly  enough  to  allow  any  system  transients  to 
damp  out  sufficiently  between  changes,  then  the  PI  control 
law  becomes 

u*(ti)  =  u*(ti_1)  -  Kx(x(ti)  -  x(t±_1)  ) 

+  £s(2d(ti>  -  ic(ti-in  (2‘44) 

A  diagram  of  this  PI  controller  form  is  shown  in  Figure  2.1 
on  the  next  page. 

This  represents  the  final  form  of  the  pseudorate  PI 
controller  derived  using  LQG  methods.  This  controller 
achieves  type  1  characteristics;  therefore,  it  will  be  able 
to  track  the  desired  nominal  trajectories  with  zero  mean 
error  despite  imperfect  models  or  constant  unknown  dis¬ 
turbances  such  as  steady  cross  winds. 

At  the  beginning  of  this  section,  two  assumptions 
were  made  which  will  now  be  justified.  First,  the  system 
was  assumed  to  be  linear  and  time  invariant.  This  assump¬ 
tion  may  seem  restrictive.  However,  one  of  the  motivations 
of  linearizing  aircraft  equations  of  motion  about  a  nominal 
flight  condition  is  to  produce  a  time  invariant  system 
model  (6)  for  ease  of  controller  synthesis;  therefore,  for 
the  purposes  of  aircraft  control  system  design,  this  is 
considered  valid.  Second,  the  original  system  in  Equation 
(2-24)  was  unrealistically  assumed  to  be  deterministic 
with  full  state  accessibility.  However,  under  the  LQG 


Fig.  2.1.  Position  Form  Pi  Control  Law  Based  on  Control  Differences 


assumptions,  certainty  equivalence  may  be  invoked  if  only 
partial,  noise-corrupted  measurements  are  available,  as  in 
the  case  of  the  regulator  design  of  the  previous  section, 
and  a  Kalman  filter  may  be  introduced  into  the  loop  to 
provide  estimates  of  the  system  states. 

2.4  Model  Following  Controllers 

Up  to  this  point  in  the  development  of  the  theory 
to  be  used  in  Chapter  V,  the  controllers  presented  have 
been  intended  primarily  for  the  purpose  of  regulating  a 
set  of  control  variables  to  zero  or  some  other  specified 
trim  condition.  Another  objective  of  the  final  controller 
to  be  implemented  in  this  study  is  the  ability  for  forcing 
the  controlled  variables  to  behave  like  those  of  a  pre¬ 
determined  model  (7:10-13).  In  terms  of  classical  control 
theory,  this  method  can  be  equated  to  designing  to  meet 
specifications  such  as  damping  ratio,  peak  overshoot,  rise 
time,  etc.  (4),  or  in  the  context  of  flight  control  this 
would  include  the  incorporation  of  handling  qualities 
(6:490-526)  specifically  into  the  design  process.  A  tech¬ 
nique  which  accomplishes  this  task  is  aptly  referred  to  as 
"model  following,"  and  can  be  divided  into  two  distinct 
categories,  both  of  which  will  be  presented  in  this  section 
Before  proceeding  with  the  development  of  the  two 


forms  of  model  following  controllers,  the  reader  is  advised 
to  keep  in  mind  that  this  section  is  intended  as  a 


conceptual  introduction  to  model  following  controllers, 
meant  primarily  for  those  who  may  not  be  familiar  with  the 
basic  theory.  The  CGT  type  of  model  following  controller 
implemented  in  Chapter  V  is  not  derived  until  Section  2.5, 
in  order  to  allow  the  reader  to  become  familiar  with  the 
general  concepts  of  model  following  before  being  exposed  to 
the  more  detailed  and  application-oriented  form  presented 
in  the  following  section.  The  material  which  follows  is 
taken  from  References  16  and  7  unless  stated  otherwise. 

The  first  class  of  model  following  controllers  is 
known  as  the  implicit  model  following  type.  This  is  due  to 
the  fact  that,  for  this  class  of  controllers,  the  system 
dynamics  of  the  model  are  not  incorporated  explicitly  into 
the  on-line  controller;  rather,  the  model  is  embedded  into 
the  definition  of  the  cost  function  and  thus  affects  the 
manner  in  which  the  controller  gains  are  evaluated.  In 
the  second  class,  the  model  system  dynamics  are  simulated 
by  the  controller,  with  the  difference  between  the  modeled 
output  and  the  system  output  being  incorporated  into  a  cost 
function.  Thus,  these  controllers  are  said  to  exhibit 
explicit  model  following  characteristics.  Implicit  model 
following  controllers  will  be  presented  first,  followed  by 
a  derivation  of  explicit  types. 

Consider  a  continuous-time  formulation  of  Equation 


(2-45) 


x(t)  =  Fx(t)  +  Bu(t) 

where  justification  of  a  deterministic  time  invariant 
model  for  flight  control  purposes  was  presented  at  the  end 
of  Section  2.3.  Also  assume  an  optimal  feedback  control 
law  of  the  following  form: 

u* (t . )  =  -G* (t . ) x (t . )  (2-46) 

—  1  — C  1  —  X 

The  above  simple  regulator  type  control  law  is  being  used 
in  order  to  provide  insights  into  implicit  model  following; 
the  same  concepts  could  be  embedded  into  a  PI  formulation 
as  well.  Note  that  u(t)  is  equal  to  u(t^)  for  t^<t<t._^ 
with  a  zero  order  hold  used  for  digital-to-analog  inter¬ 
facing.  An  optimal  control  function  can  be  achieved  based 
on  Equation  (2-46)  by  minimizing  the  continuous-time  cost 
function 


JI  =  I  J  txT(t)X*<t)  +  uT(t)  Uu(t)  ]dt  (2  47) 

0 

where  Equation  (2-47)  exerts  a  quadratic  weight  on  control 
energy  and  state  trajectory  deviation'  from  zero.  A 
discrete-time  version  of  Equation  (2-47)  can  be  derived 
based  upon  the  same  procedure  used  to  discretize  Equation 
(2-16)  (11:203,225).  Note  that  the  infinite  upper  inte¬ 

gration  limit  in  Equation  (2-47)  will  allow  for  constant 
gain  controllers  since  terminal  transients  can  be  neglected. 


Now  define  a  set  of  controlled  variables 


y(t)  =  Cx(t)  (2-48) 

It  is  desired  that  the  trajectories  of  these  controlled 
variables  track  a  set  of  model  variables  denoted  by  the 
differential  equation 

*m(t)  "  (2"49> 

where  it  is  required  that  both  ym(t)  and  y(t)  be  p-dimen- 
sional  vectors. 

In  order  to  provide  a  weighting  on  controlled 
variable  deviation  from  the  model  characteristics  described 
by  Equation  (2-49) ,  a  quadratic  cost  is  established  that 
will  penalize  y(t)  deviations  from  the  desired  character¬ 
istics  of: 


y(t)  =  Fmy(t)  (2-50) 

Thus,  by  implicitly  incorporating  the  modeled  system  into 

the  cost  function  by  placing  a  quadratic  penalty  on  the 

difference  between  the  actual  y  and  the  right  side  of 

Equation  (2-50)  ,  and  also  adding  a  cost  on  the  control 
r  2 

"energy"  *s  Z  u.(t),  the  quadratic  cost  function  becomes 

• _ i  i 
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(2-51) 


The  cross  term  Sj  arises  due  to  the  need  to  track 
derivatives  of  the  system  outputs,  i.e.  output  rates  of 
Equation  (2-50) .  Once  the  cost  function  of  Equation  (2-52) 
has  been  defined,  an  equivalent  discrete  form  may  be 
derived  to  yield  a  sample  data  control  law  rather  than  a 
continuous  type  (12:74-76).  Controllers  for  this  sample 
data  system  can  be  derived  via  methods  presented  in  either 
Section  2.2  or  Section  2.3  to  yield  an  optimal  control 
function  u* ( t^) . 


A  second  approach  to  model  following  design  is 


explicit  model  following.  In  order  to  present  this 

approach,  the  same  basic  system  of  Equation  (2-45)  will  be 

employed.  It  is  worth  noting  that  although  the  same  model 

equation  is  used  in  the  derivation  of  both  the  implicit  and 

explicit  model  following  controllers,  the  F  is  not  the 

— m 

same  for  both  cases. 

Consider  a  system  modeling  the  desired  character¬ 
istics  of  the  plant 


F  x 
— m  — m 


(2-56) 


where  time  arguments  have  been  dropped  for  notational 
tractability . 

Now  define  a  new  state  equation  based  on  the  aug¬ 
mentation  of  the  plant  states  and  the  model  states 


x'  = 


dt 


— 

— 

— 

—  — 

—  — 

x 

F 

0 

X 

B 

= 

+ 

X 

0 

F 

X 

0 

— lit 

— m 

— m 

u 


(2-57) 


Thus  Equation  (2-57)  may  be  represented  by 

x '  =  F’x '  +  B'u  (2-58) 

The  output  vector  for  the  augmented  system  is  defined  by 


=  (y  -  y  )  =  cx  -  c  x  =  [c 
J-c  —  -m-m  - 


!  CJ 

•  —  m 


x 

— m 


=  C’x'(2-59) 


32 


where  C'  is  chosen  to  accomplish  the  desired  differencing 
between  modeled  state  variables  and  plant  controlled  vari¬ 
ables.  Therefore,  a  standard  quadratic  performance  index 
may  be  defined  by 

CD 

-E  =  f  I(£'TXeX  +  uT  Ru)dt  (2-60) 

0 

The  optimal  control  input  for  the  augmented  system 
as  generated  by  solving  the  backward  Riccati  difference 
equation  associated  with  Equation  (2-60)  is 

u*  =  -[G*  G*  ]  x'  (2-61) 

—  —Cl  — C2  — 

From  Equation  (2-61)  it  can  be  seen  that  the  optimal  con¬ 
trol  input  to  the  system  is  comprised  of  the  system  states 
fed  back  through  a  gain  matrix  G^,  plus  model  states  fed 
forward  through  the  set  of  gains  G£2.  The  feedback  through 
G£^  should  provide  for  tight  tracking  (7:10-13)  which 
yields  a  system  that  is  fast  enough  to  follow  the  responses 
of  the  modeled  system  as  commanded  through  the  feedforward 
controller  structure.  It  can  be  shown  that  the  feedback 
compensator  is  independent  of  the  structure  of  the 
explicitly  modeled  system.  Thus,  a  simple  regulator  or  a 
PI  controller  may  be  designed  independently  of  the  explicit 
model  characteristics.  As  will  be  shown  in  the  subsequent 
section,  this  feedback  may  be  structured  in  such  a  manner 


as  to  exploit  implicit  model  following  to  enhance  con¬ 
troller  robustness  characteristics  and  explicit  model  fol¬ 
lowing  for  handling  qualities. 


Either  of  the  previously  discussed  model  following 
techniques  would  prove  to  be  adequate  under  the  idealized 
assumptions  of  perfect  models  which  were  uncorrupted  by 
disturbances.  However,  in  actual  application  each  type 
exhibits  certain  advantages  and  disadvantages  relative  to 
the  other. 

Implicit  model  following  bases  its  control  on  a 
weighting  of  rate  deviations,  as  evidenced  by  Equation 
(2-51).  Therefore,  this  type  of  controller  achieves  a 
better  tracking  of  the  transient  response  of  the  model  sys¬ 
tem  than  explicit  model  following  controllers  do.  Also, 
since  the  implicit  formulation  attempts  to  match  system  and 
model  pole  placement,  this  method  exhibits  better  rejec¬ 
tion  of  unmodeled  zero  mean  disturbances  than  explicit 
types.  Specifically,  since  it  affects  the  feedback  path 
rather  than  a  feedforward  path,  implicit  model  following  may 
be  used  to  improve  the  robustness  of  the  controlled  system. 

As  previously  stated,  the  explicit  model  following 
technique  must  embed  a  model  of  the  system  dynamics  within 
the  controller.  The  impact  of  this  embedded  model  is 
twofold.  First,  a  more  complex  controller  is  needed  since 
the  model  states  are  augmented  to  the  system  states.  This 
entails  higher  computational  loading.  Second,  a  time  lag 


mmm 


may  be  introduced  into  the  system,  possibly  forcing  the 
designer  to  settle  for  a  suboptimal  control  law  to  offset 
this  controller-induced  delay.  Since  the  actual  difference 
between  the  system  and  model  outputs  are  weighted,  no  spe¬ 
cific  pole  placement  is  achieved  as  in  the  implicit  scheme; 
thus,  the  explicit  model  controller  often  must  maintain 
higher  feedback  gains  in  order  to  track  modeled  transient 
responses.  However,  this  direct  comparison  of  system  and 
model  outputs  also  produce  desirable  qualities  such  as 
improved  steady  state  performance  and  reduced  sensitivity 
to  parameter  variations  (7:10-13;  16:1-8). 

A  primary  area  of  importance  to  be  considered  when 
weighing  the  relative  advantages  and  disadvantages  of  model 
following  controllers  is  robustness  enhancement  (see 
Chapter  IV) .  The  implicit  model  following  controller  can 
have  an  effect  on  system  robustness  since  it  incorporates 
a  model  system  into  the  cost  function  to  be  minimized  and 
thereby  affects  the  feedback  gains.  Therefore,  if  the  form 
of  the  implicit  model  is  chosen  properly,  it  can  improve  the 
overall  robustness  of  the  system  (7:10-13).  Alternatively, 
the  explicit  scheme  allows  the  model  to  affect  only  the 
feedforward  path  of  the  control  system.  As  a  result  of 
this,  the  controller  based  solely  upon  an  explicit  model 
could  improve  handling  qualities;  however,  it  would  not  be 
able  to  improve  system  robustness  characteristics  (14) . 

In  view  of  the  apparent  differences  between  the  objectives 
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to  be  achieved  by  implementing  an  implicit  or  explicit  con¬ 
troller,  it  should  be  emphasized  that  the  implicit  and 
explicit  models  are  not  one  in  the  same. 

In  the  past  the  implicit  approach  has  been  more 
widely  used  due  mainly  to  its  ease  of  implementation 
(7:10-13).  However,  an  approach  which  will  be  introduced 
in  the  following  section  of  this  chapter  will  propose  using 
both  implicit  and  explicit  forms  in  one  controller  in  an 
attempt  to  achieve  the  desirable  characteristics  of  each. 

2 . 5  Command  Generator  Tracker 

Synthesis  Techniques 

This  section  introduces  the  controller  design  tech¬ 
nique  known  as  command  generator  tracking  (CGT) .  This 
formulation  requires  a  system  to  track  commanded  inputs 
with  desirable  response  characteristics,  while  simultane¬ 
ously  rejecting  disturbances.  Thus,  the  CGT  controller  is 
capable  of  forcing  the  system  state  variables  of  interest 
to  maintain  desired  trajectories  (12:151,166).  In  terms  of 
the  language  introduced  in  the  previous  section,  the  CGT 
scheme  relies  on  explicit  model  following  techniques; 
however,  as  will  be  discussed  later  in  this  section, 
implicit  model  following  may  also  be  incorporated  into 
CGT/regulator  or  CGT/PI  designs  (16;  7:10-13;  14).  The  CGT 
technique  is  particularly  attractive  for  aircraft  flight 
controller  design  because  it  allows  handling  qualities  to 
be  incorporated  directly  into  the  design  process. 
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In  order  to  develop  the  CGT  technique,  consider  the 
linear  time  invariant  system  model 


x(ti+l)  =  +Bdu(ti)  +Exn  ( )  +wd(t.)  (2-62) 


Z(t±)  =  Cx(ti)  +Dyu(ti) 


(2-63) 


where  wd(t^)  is  a  zero-mean  white  Gaussian  noise  sequence, 
and  n^t^)  is  a  time  correlated  noise  sequence  modeled  by 

Sdlti+1>  =  ±„2d(V  ^d^cmd'V  +2d>Ain,ti)  '2-64) 


It  is  desired  that  the  output  of  Equation  (2-63)  emulate 
the  output  of  a  command  generator  model 


x  (t .  .  i  )  =  4>x_  (t.)  +  B ,  u 
— m  i+l  — m— m  i  — am— m 


(2-65) 


*m 


(t.)  =  Cx  (t.)+Du 
l  — m-m  l  — m— m 


(2-66) 


where  y  (t.)  and  y(t.)  must  both  be  of  dimension  p.  For 

i  A  1  c 

flight  control  applications,  the  input  um  to  the  command 
generator  model  can  be  considered  piecewise  constant  over 
a  time  interval  of  interest  since  it  is  assumed  to  vary 
slowly  in  comparison  to  the  sampling  rate  of  the  digital 
control  system. 

In  order  to  achieve  tracking  of  the  modeled  system, 
the  CGT  must  drive  the  error 


e  (t  • )  =  (t  • )  -  v  (fcn  ) 

—  i  *-c  i  *-m  l 


(2-67) 
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to  zero.  In  terms  of  the  previously  established  models 
Equation  (2-67)  can  be  expressed  as 


e  (t . )  =  (CD  E  ) 

—  1  - y  — y 

For  convenience  in  construction  of  the  final  CGT 
law,  an  ideal  trajectory  can  be  defined  as  the  plant  state 
trajectory  which  will  drive  Equation  (2-68)  to  zero  for  all 
time  and  satisfy 


X(t.) 

r-  — | 

—  1 

x  ( t . ) 

u  (  t  .  ) 

-[CD] 

— m  i 

—  1 

— m  — m 

u 

— m  _ 

2d(ti> 

(2-68) 


*I«W  * 


$  Xj 


(ti)  +  Sd“i 


<ti> 


+  — x-d 


(2-69) 


The  stated  desire  to  drive  the  error  defined  in 
Equation  (2-67)  to  zero,  coupled  with  the  form  of  Equations 
(2-68)  and  (2-69)  can  be  combined  with  a  third  condition: 


Si(ti> 

In 

-12 

—13 

Si'V 

42i 

-2  2 

— 23_ 

x  (t.) 
— m  i 

W 

W 


(2-70) 


Recalling  Equation  (2-29)  , 
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the  solution  to  the  CGT  problem  formulation  can  be  shown 
(12:155)  to  be  of  the  form  of  Equation  (2-70)  with: 


*11  -  ill  *11  «4,-i»+ll2£m 


(2-72) 


*12  =  *11  *ll2dm+  *12  2m 


*13  *ll*13<-n"*)  ■*ll*x“*12*y 


a_ ,  =  n„  a,,  (i  -  i)+n_^c 

—21  —21—11  — m  —  — 22— m 


-22  -21-1 1— dm+  -2  2  -m 


(2-73) 

(2-74) 

(2-75) 

(2-76) 


-23  -21-13(-n"-)  " -21 -x~ -22 -y 


(2-77) 


Upon  solving  Equations  (2-72)  through  (2-77) ,  the  control 
input  can  be  generated  as  ths  lower  partition  of  Equation 
(2-70)  : 


*I(ti»  "  *2lVti)  +  *22*m(ti)  '2'78» 


The  block  diagram  of  the  control  1  „w  represented  by 
Equation  (2-77)  is  shown  in  Figure  2.2  on  the  next  page. 

As  evidenced  by  Figure  2.2,  this  formulation  of  the 
CGT  law  is  an  open  loop  form;  therefore,  this  controller 
will  not  compensate  for  uncertainties  in  the  system  model. 
The  need  to  compensate  for  these  inevitable  uncertainties 
which  arise  in  flight  control  applications  motivates  the 
construction  of  a  CGT  law  which  incorporates  feedback  into 
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the  final  design.  A  second  improvement  over  the  simple 
open  loop  configuration  CGT  would  be  the  use  of  a  closed 
loop  PI  law,  instead  of  a  simple  regulator  law,  thus  yield¬ 
ing  a  command  generator  tracking/proportional  plus  integral 
or  (CGT/PI) ,  controller.  The  advantage  of  a  CGT/PI  con¬ 
troller  is  that  it  enables  the  system  to  achieve  type  1 
characteristics:  (1)  it  can  force  the  mean  steady  state 
error  between  the  actual  plant  and  the  command  generator 
model  to  zero,  and  (2)  it  can  reject  modeled  and  unmodeled 
disturbance  inputs. 

The  CGT/PI  control  law  that  is  used  for  the  purpose 
this  thesis  provides  type  1  system  characteristics  and  has 
the  desirable  quality  of  being  derived  via  LQG  synthesis 
methods.  The  final  form  of  this  controller  can  be  shown 
to  be  of  the  following  form  (16:2-15): 


u(ti)  =  u(ti_1)  -Kx(x(ti)  ~x(ti_1)) 


+  K  [C  D  ] 
— z  I  — m  — m 


x_  (  fc  h  _  1  >  ,) 

-m  11  -  [CD]  11 

W  Y  s'Vi1 


+  Kvm  )  ~  x  (t,-  1  )  ) 

— xm  — m  i  — m  l-i 

+  K  (u  (t . )  -  u  (t .  .  )  ) 
—xu  — m  i  — m  i-x 


+  K  (n.(t .)  -  n.  (t.  . )  ) 
— xn  — d  l  — d  i-l 


(2-79) 


(The  use  of  u  at  t .  instead  of  t.  .  accounts  for  an  incon- 
-m  l  i-l 

sistency  in  the  definition  of  the  desired  state  trajectory 


when  a  step  change  to  u  is  applied  (12:161-162).)  In 


terms  of  Section  2.3  the  gains  associated  with  Equation 
(2-79)  are  defined  as: 


K  =  G*ini  .  +  G*  IT.. 
— x  —cl— 11  — c2— 21 


+  S*2n22 


K  =  K  A,  ,  +  A,, 
— xm  — x— 11  —21 


K  =  K  A..  +  A_  _ 
—XU  — x— 12  —22 


Kx  =  K  A.  ,  +  A  - 
—  n  — x— 13  —23 


(2-80) 

(2-81) 

(2-82) 

(2-83) 

(2-84) 


Up  to  this  point  the  assumption  of  full  state  feed¬ 
back  has  been  allowed,  due  to  certainty  equivalence.  In 
order  to  account  for  the  more  accurate  physical  case  of 
incomplete,  noise-corrupted  state  availability,  a  Kalman 
filter  can  be  introduced  into  the  design  process.  This 
final  innovation  will  produce  what  is  termed  the  Command 
Generator  Tracking/Proportional  plus  Integral/Kalman  Filter 
(CGT/PI/KF)  controller.  The  type  of  Kalman  filter  to  be 
employed  in  the  CGT/PI/KF  design  is  a  standard  steady  state, 
constant-gain  filter  designed  for  time  invariant  system 
models  with  stationary  noises,  ignoring  the  initial  gain 
transients.  For  flight  control  applications  a  constant- 
gain  filter  is  acceptable  due  to  the  relatively  short 
transient  period  experienced  in  relation  to  the  steady  state 
operation  of  the  aircraft. 


The  Kalman  filter  will  produce  a  state  estimate 

*  -f* 

x(t^);  however,  in  cases  where  unmodeled  physical  delays 
within  the  structure  of  the  plant  or  controller  are  present, 
a  control  law  may  preferably  be  established  based  upon 

/N  _ 

x(t^)  (12:161).  Basing  the  control  input  on  measurements 

up  to,  but  not  including,  the  measurement  that  becomes 

available  at  time  t^can  remove  computational  delay  time; 

however,  the  resulting  control  law  is  less  precise  than  a 
~  + 

law  based  on  x(t.  ).  The  modeled  noise  states  n,(t.)  may 
—  x  —a  1 

also  be  replaced  with  Kalman  filter  estimates,  but  it  must 
be  remembered  that  the  plant  state  estimates  and  the  noise 
state  estimates  do  not  decompose  into  the  independent 
filters  (12:166).  Considering  the  above,  the  filter  model 
will  simply  consist  of  the  dynamics  model  of  the  plant 
augmented  with  the  dynamics  model  of  the  time  correlated 
noise  corruption  (16).  This  augmented  filter  configuration 
has  a  measurement  model  of  the  form 

x  (t . ) 

z(t.)  =  [H  H  ]  1  +  v(t.)  (2-85) 

LwJ 

where  v(t^)  is  characterized  as  a  white  zero-mean  Gaussian 
noise  sequence  with  a  covariance  R. 

The  previous  discussion  developed  the  fundamental 
design  equations  needed  to  implement  the  CGT/PI/KF  con¬ 
troller.  Although  this  form  of  the  CGT  law  is  desirable 


in  that  it  incorporates  a  PI  controller  to  achieve  type  1 
performance  characteristics,  it  has  the  drawback  of  being 
difficult  to  robustify  (see  Chapter  IV  for  a  discussion  of 
robustness  enhancement).  Therefore,  a  slight  digression 
is  in  order  so  that  a  less  elaborate  form  of  the  CGT  law 
may  be  presented.  This  particular  form  of  the  CGT  con¬ 
troller  replaces  the  PI  feedback  channel  with  a  simple 
regulator  and  may  be  used  if  problems  arise  as  a  result  of 
applying  specific  robustness  enhancement  techniques. 

The  Command  Generator  Tracker/Regulator  (CGT/R) 
is  developed  fully  in  Reference  12  where  it  is  shown  to  be 
of  the  following  form: 


u  ( t . )  =  -G*  x  (t . )  +  (A- .  +  G*  A. .  )  x  (t.) 
—  1  — c  —  i  —21  — c  —11  -m  l 


+  (-22  +-J  ^12}  ~m(ti)  +  (— 23  +  -?-13)  ild(ti) 


(2-86) 


As  in  the  CGT/PI  case,  the  states  of  the  plant  and  modeled 
noise  corruptions  may  be  estimated  by  a  Kalman  filter  to 
yield  a  CGT/R/KF  design.  A  block  diagram  of  the  CGT/PI/KF 
form  is  shown  in  Figure  2.3  on  the  next  page. 

The  last  topic  to  be  discussed  in  this  section 
relates  to  the  model  following  techniques  introduced  in 
Section  2.4.  As  previously  stated,  there  exist  two  sub¬ 
categories  of  model  following  controllers:  implicit  and 
explicit;  however,  these  two  forms  are  not  mutually 


Block  Diagram  of  the  CGT/PI/KF  Controller 


exclusive.  In  this  thesis  the  work  developed  by  Miller  (16) 
will  be  implemented  to  derive  a  controller  which  exploits 
both  implicit  and  explicit  model  following  through  use  of  a 
quadratic  cost  function  of  the  form 

00 

Jc  -  1  J 
0 

+  <*- 

+  uTUu)dt  (2-87) 

By  using  a  cost  function  of  the  form  of  Equation 
(2-87) ,  both  the  handling  qualities  and  robustness  charac¬ 
teristics  may  be  improved  by  use  of  explicit  and  implicit 
model  following,  respectively. 

Although  some  standard  initialization  steps  can  be 
used  to  make  a  first  estimate  of  YT  and  Y  ,  these  weightings 
are  usually  developed  through  an  iterative  trial  and  error 
method.  Chapter  V  will  provide  some  insights  into  this 
process . 


2 . 6  Summary 

This  chapter  has  served  to  generate  the  basic  design 
tools  used  in  the  aircraft  controller  design  of  Chapter  V. 
First,  the  fundamental  LQG  regulator  was  introduced  and  its 
uses  and  shortcomings  were  assessed.  Next,  the  PI  con¬ 
troller  of  classical  control  theory  was  developed  using 
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powerful  modern  LQG  methods.  Sections  2.4  and  2.5  pre¬ 
sented  both  general  model  following  theory  and  more  spe¬ 
cific  CGT/PI  and  CGT/R  control  forms.  Certainty  equivalence 
then  allowed  definition  of  CGT/PI /KF  and  CGT/R/KF  laws. 

The  CGT/PI/KF  controller  design  laws  will  be  applied  to  a 


fighter  aircraft  combat  mode  controller  in  Chapter  V  using 
interactive  computer-aided  design  and  evaluation  packages 
(7;  16;  17). 
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III.  Modeling  Considerations  for  the  STOL  F-15 

3 . 1  Introduction 

This  chapter  will  introduce  the  models  upon  which 
the  controller  designs  of  Chapter  V  are  based.  Also,  some 
of  the  unique  features  of  the  short  takeoff  and  landing 
(STOL)  F-15  will  be  discussed.  In  the  interest  of  clarity 
and  brevity,  such  data  as  aerodynamic  derivatives  and  air¬ 
craft  state  models  within  the  flight  envelope  will  not  all 
be  presented  at  this  time;  instead,  these  data  will  be 
included  in  Appendix  B.  The  design  software  used  in  this 
thesis  (7;  16) ,  will  be  introduced  inasmuch  as  it  is  needed 
to  justify  specific  model  development.  Those  readers  who 
desire  a  more  detailed  discussion  of  the  software  are 
directed  to  References  7  and  16. 

The  STOL  F-15  is  a  modified  version  of  the  F-15 
currently  being  used  by  the  United  States  Air  Force  as  an 
air  superiority  fighter  aircraft.  The  major  modifications 
to  the  standard  F-15  which  produce  the  STOL  capability  are 
the  introduction  of  canards,  rotating  vanes,  and  two 


dimensional  thrust  vectoring  nozzles.  Of  these  three 
modifications,  the  vanes  and  thrust  nozzles  are  unconven¬ 
tional  control  surfaces  and  bear  future  explanation.  The 
rotating  vanes  consist  of  four  louvered  panels  located  on 
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the  upper  and  lower  surfaces  of  the  thrust  vectoring  attach 
ment  located  at  the  rear  of  the  engines.  The  two  dimen¬ 
sional  nozzles  are  located  at  the  rear  of  the  same  thrust 
vectoring  assembly.  This  thesis  effort  will  be  limited  to 
a  controller  design  for  the  "up  and  away"  characteristics 
of  the  STOL  F-15.  Since  the  rotating  vanes  do  not  provide 
a  significant  amount  of  control  within  the  flight  envelope 
being  studied,  they  will  be  considered  closed  at  all  times. 
Therefore,  the  vanes  are  completely  eliminated  from  the 
control  input  vector. 

The  second  section  of  this  chapter  will  introduce 
some  of  the  basic  aerodynamic  modeling  considerations 
relevant  to  the  control  of  the  STOL  F-15  aircraft.  Sec¬ 
tion  3.3  discusses  some  of  the  models  other  than  the  basic 
aircraft  model  which  are  motivated  by  the  CGT  design  method 
and  the  computer  aided  design  (CAD)  package  used  to  imple¬ 
ment  this  design  method.  The  flight  envelope  of  the 
STOL  F-15  is  the  topic  of  Section  3.4.  The  nominal  design 
point  is  specified  and  other  points  in  the  flight  envelope 
are  discussed  as  well,  with  the  goal  of  establishing  a 
"nominal"  point  to  be  used  for  controller  designs  and 
several  points  on  the  edge  of  the  envelope  to  be  used  to 
evaluate  the  robustness  of  these  designs. 

The  final  section  of  this  chapter  provides  a  sum¬ 
mary  of  the  topics  presented  and  highlights  those  areas  of 
particular  relevance  to  the  subsequent  chapters. 


Modeling  the  STOL  F-15  Aircraft 

This  section  will  discuss  the  construction  of  the 
linearized  model  used  to  represent  the  STOL  F-15  aircraft. 
This  presentation  will  assume  that  the  reader  is  familiar 
with  atmospheric  flight  dynamics;  those  who  require  a 
detailed  presentation  of  the  fundamental  principles  of 
aircraft  modeling  and  flight  control  are  directed  to  Refer¬ 
ences  6  and  7.  The  basic  aircraft  model  is  derived  from 
the  general  nonlinear  equations  of  motion  which  describe 
the  dynamics  of  the  STOL  F-15.  These  equations  can  be 
greatly  simplified  by  assuming  that:  1)  the  earth  is  an 
inertial  plane  as  opposed  to  a  non-inertial  spheroid.  This 
"flat  earth"  assumption  can  be  considered  reasonable  at 
flight  conditions  which  do  not  exceed  Mach  3  (6) ,  which  is 
well  below  all  velocities  being  considered  in  this  thesis; 
2)  the  atmosphere  is  at  rest;  3)  all  elastic  effects  will 
be  considered  negligible,  yielding  a  "rigid  body"  model 
with  no  elastic  freedom.  The  rejection  of  wind  buffeting 
could  be  incorporated  into  the  controller  synthesis 
methodology  (12:151;  14);  however,  this  issue  will  not  be 
addressed  herein.  The  ability  of  the  controller  to  reject 
such  disturbances  without  explicitly  modeling  them  will  be 
assessed,  however.  The  force  and  moment  equations  which 
result  from  the  above  simplifying  assumptions  may  be 
linearized  about  specific  flight  conditions,  using  small 
disturbance  theory  (6:154),  resulting  in  a  linearized  model 
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for  the  STOL  F-15.  By  invoking  the  assumptions  concerning 
aircraft  symmetry,  absence  of  gyroscopic  effects,  and 
neglecting  aerodynamic  cross  coupling  terms  (6:161),  the 
lateral  and  longitudinal  modes  of  the  STOL  F-15  may  be 
completely  decoupled  and  treated  separately  for  the  pur¬ 
poses  of  controller  design.  It  is  this  set  of  decoupled, 
linearized  equations  of  motion  placed  in  matrix  form  which 
will  be  developed  for  the  longitudinal  mode  of  flight. 

The  aerodynamic  data  at  various  operating  points 
within  the  flight  envelope  of  the  STOL  F-15  were  provided 
by  McDonnell  Aircraft  Engineering  (McAir) .  These  data  con¬ 
sisted  of  aircraft  parameters  and  longitudinal  and  lateral 
non-dimensionalized  body  axis  force  coefficients.  Also, 
moments  of  inertia  were  provided;  however,  these  were  pro¬ 
vided  in  dimensionalized  body  axis  form.  In  order  to  con¬ 
vert  the  data  provided  by  McAir  into  dimensionalized  body 
axis  form,  an  existing  axis  conversion  program  written  by 
Mr.  Finley  Barfield  (3)  was  modified  by  Capt.  Greg  Mandt 
and  Lt.  Bruce  Clough,  and  re-named  STOLCAT.  STOLCAT 
incorporates  the  non-dimensionalized  body  axis  force  coef¬ 
ficients  associated  with  the  canards,  two  dimensional  thrust 
nozzles,  and  rotating  vanes,  along  with  the  conventional 
force  coefficients  to  produce  a  set  of  dimensionalized  body 
axis  coefficients.  The  STOLCAT  software  also  forms  both 
the  lateral  and  longitudinal  state  space  three-degree-of- 
freedom  equations  of  motion  of  the  following  form: 
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x ( t)  =  Fx  +  Bu  (t ) 


where 

x  =  aircraft  state  vector 
F  =  aircraft  dynamics  fundamental  matrix 
B  =  control  derivative  matrix 
u  =  control  vector 


At  Mach  0.9  at  20,000  feet  of  altitude,  Equation  (3-1) 
is: 


u 

-.018 

-20.023 

27.9 

-32.19 

q 

- . 23X10~3 

-1.999 

10.81 

0 

• 

a 

-.34X10"6 

.9997 

-1.49511 

-7.4X10-3 

• 

9 

_  0 
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0 

0 
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-9.9 
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A  complete  FORTRAN  program  listing  of  STOLCAT,  along  with 
the  aerodynamic  data  for  the  STOL-F-15,  are  included  in 
Appendices  A  and  B  of  this  thesis. 

In  the  longitudinal  mode  the  control  vector  con¬ 
sists  of  the  canard  input  6  ,  the  stabilator  input  <5  ,  and 
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the  throttle  input  6^.  Although  the  rotating  vanes  and 
thrust  vectoring  nozzles  are  available,  they  are  not  used 
in  the  designs  considered  in  this  thesis.  The  vanes  are 
neglected  due  to  their  limited  usefulness  at  the  altitude 
and  airspeeds  that  are  being  considered.  The  nozzles  are 
useful  for  "up-and-away"  flight;  however,  the  simultaneous 
control  of  thrust  and  nozzle  deflection  introduces  a 
severe  nonlinearity  into  the  system  dynamics  which  is 
beyond  the  scope  of  this  thesis  (see  Appendix  C  for  a  more 
complete  discussion  of  this  nonlinear  effect) .  The  longi¬ 
tudinal  control  vector  is  shown  below: 

5c<t) 

u ( t )  =  6S(t)  (3-2) 

$T(t) 

Although  a  basic  state  model  representing  the  air¬ 
craft  dynamics  can  be  produced  by  the  methods  discussed  in 
this  section,  this  model  alone  will  not  be  sufficient  to 
accomplish  the  controller  designs  required  of  this  thesis 
effort.  The  use  of  CGT  techniques  and  the  desire  to 


accomplish  performance  evaluations  of  the  final  designs 
require  that  other  dynamics  models  be  constructed.  The 
following  section  will  discuss  these  other  dynamics  models, 
which  will  be  used  along  with  the  basic  aircraft  design 
model  to  affect  the  final  designs  of  Chapter  V. 

3 . 3  Models  for  CGT  Design  and 

Performance  Evaluation 

Although  the  previous  section  developed  the  linear¬ 
ized  decoupled  equations  of  motion  for  the  STOL  F-15,  these 
equations  alone  will  not  be  sufficient  to  complete  the 
designs  required  of  this  thesis.  This  section  will  intro¬ 
duce  the  reader  to  the  models  other  than  the  basic  aircraft 
model  which  will  be  used  in  Chapter  V.  The  models  presented 
in  this  chapter  will  be  somewhat  general  in  nature,  thus 
saving  the  detailed  descriptions  of  the  models  particular 
to  the  STOL  F-15  for  Chapter  V  and  Appendix  B. 

The  underlying  motivation  for  the  following  models 
is  theoretical  in  nature  (see  Chapter  II);  however,  their 
specific  form  is  dictated  by  the  CAD  package  CGTPIF  (7;  16). 
A  discussion  of  the  models  from  a  software  user's  point  of 
view  will  be  presented  at  this  time  in  order  to  give  the 
reader  a  qualitative  understanding  of  the  models  as  they 
pertain  to  the  use  of  CGTPIF.  Therefore,  the  goal  of  this 
section  is  to  ground  the  reader  in  the  uses  of  the  various 
models  presented  herein  before  the  actual  CGT  designs  are 
presented . 
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Four  different  models  will  be  described  in  this 
section.  The  first  is  the  design  model ,  followed  by  the 
command  model  or  explicit  model ,  the  truth  model,  and 
finally,  the  implicit  model . 

The  design  model  used  by  CGTPIF  is  the  primary 
model  used  in  the  design  process.  It  is  derived  from  the 
basic  aircraft  model  Equation  (3-1) ,  augmented  with  noise 
inputs.  The  specific  form  of  the  design  model  which  is 


required  by  CGTPIF  is  as  follows  (7): 

*(t)  =  Fx  ( t)  +  Bu  ( t)  +  Exn  +  Gw  ( t)  (3-3) 

n(t)  =  F  n  ( t)  +  G  w  (t)  (3-4) 

—  — n—  — n— n 

y(t)  =  Cx  (t)  +  Dyu(t)  (3-5) 

z(t±)=  Hx(ti)  +  v(t±)  (3-6) 
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,v. 


£ 
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where  y  represents  the  controlled  outputs  and  z  is  the 
noise-corrupted  measurement  vector.  The  n  term  denotes  a 
time  correlated  noise  disturbance  input  into  the  system 
which  is  to  be  rejected  by  the  controller;  however,  for  the 
purposes  of  the  work  accomplished  in  this  thesis,  this  input 
will  be  removed  from  the  system.  The  noise  inputs  of  the 
system  are  characterized  by 


E{w( t) wT (t+T)  } 

=  Q<5  (x ) 

(3-7) 

E  {  W  (t) wT (t+T)  } 
— n  — n 

=  QnMx) 

(3-8) 
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and  the  measurement  noise  of  the  system  is  described  by 

E{v(ti)vT(tj) }  =  R6ij  (3-9 

The  dimensionalities  which  must  be  established  before 
entering  the  design  model  in  the  CGTPIF  software  are 

n  =  number  of  system  states 
r  =  number  of  system  inputs 
p  =  number  of  system  outputs 
m  =  number  of  system  measurements 
w  =  number  of  independent  system  noises 

The  command  model  is  an  explicit  model  (see  Sec¬ 
tions  2.4  and  2.5)  used  to  describe  the  desired  behavior 
of  the  system.  Embedded  in  this  model  are  the  specifica¬ 
tions  that  the  actual  system  must  meet.  Typically  for 
flight  control  applications  this  model  will  be  used  to 
command  a  second  order  response  for  the  output  variables, 
thus  allowing  incorporation  of  specified  handling  quali¬ 
ties  or  "feel"  of  the  aircraft  as  it  responds  to  the 
pilot's  control  inputs.  A  second  possible  flight  control 
application  for  the  command  model  would  be  to  command  an 
optimal  evasive  maneuver  for  an  aircraft  operating  in  a 
combat  situation.  The  specific  form  of  this  model  as 
dictated  by  CGTPIF  is  as  follows: 


x„(t)  =  F.,x_(t)  +  B-U_(t) 


(3-10) 


Ye  =  CEx£(t)  +  D£uE(t) 


(3-11) 


where  the  subscript  E  denotes  Explicit  model ,  and  dimen¬ 
sionalities  for  the  command  model  are 

n  =  number  of  command  model  states 

r£  =  number  of  command  model  inputs 

PE  =  number  of  command  model  outputs 

CGTPIF  further  requires  that  the  number  of  command  model 
states  be  less  than  or  equal  to  the  number  of  design  model 
states  (software  constraint;  theoretical  extensions  are 
possible) ,  and  that  the  number  of  system  outputs  be  equal 
to  the  number  of  command  model  outputs  (logical  theoretical 
constraint,  since  system  outputs  are  supposed  to  track  the 
command  model  outputs) . 

CGTPIF  (7;  16)  not  only  provides  for  the  design  of 
Command  Generator  Tracker/Proportional  plus  Integral/Kalman 
Filter  (CGT/PI/KF)  and  Command  Generator  Tracker /Regulator/ 
Kalman  Filter  (CGT/R/KF)  controllers,  but  provides  for  per¬ 
formance  analysis  of  the  resulting  designs.  In  order  to 
accomplish  this  analysis,  a  linear  model  must  be  created 
which  represents,  as  closely  as  possible,  the  actual 
dynamics  of  the  system.  This  "truth  model"  will  represent 
the  same  system  as  the  design  model;  however,  it  will 
typically  be  of  a  higher  dimensionality  and  complexity  than 
the  design  model  since  it  will  include  higher  order  sensor 
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and  actuator  dynamics  as  well  as  wind  buffeting  states 
possibly  ignored  in  the  CGT  design  process.  The  form  of 
the  truth  model  required  by  CGTPIF  is  found  in  Reference  7 
to  be: 


*T(t) 

=  IrjZrpit)  +  B^U)  +  G^tt) 

(3-12) 

W 

=  HTxT(ti)  +  vT(ti) 

(3-13) 

x(t) 

-DT-T  * ^ 

(3-14) 

n  ( t) 

— NT— T ( ' 

(3-15) 

with  associated  noise  statistics 

E{wT(t)w£(t+i)  }  =  Qt6<t)  (3-16) 

EtWvJf  t.  )  }  =  6..  (3-17) 

where 

n_  =  number  of  truth  model  states 
T 

rT  =  number  of  truth  model  inputs 

mT  =  number  of  truth  model  measurements 

wT  =  number  of  independent  noises  in  the  truth  model 

In  Equations  (3-14)  and  (3-15) ,  TDT  and  TNT  are  matrices 
which  transform  the  truth  model  state  and  disturbance 
vectors  into  vectors  corresponding  to  the  design  model 
state  and  disturbance  vectors  respectively.  In  order  for 
CGTPIF  to  accomplish  an  analysis  of  the  designed  system, 
obviously  r_,  must  be  equal  to  r,  and  nu,  must  equal  m. 


The  last  model  to  be  introduced  in  this  section  is 
the  implicit  model.  This  model  is  not  as  easily  under¬ 
stood  on  an  intuitive  level  as  the  previous  three  (see  Sec¬ 
tion  2.4);  however,  it  may  be  thought  of  as  a  means  of  pro¬ 
viding  a  pole  placement  technique  to  improve  the  robustness 
characteristics  of  the  overall  control  system  (see  Section 
4.2).  The  implicit  model  is  so  named  because  it  is  embedded 
into  the  process  of  choosing  the  weights  of  an  LQ  controller 
and  does  not,  unlike  the  explicit  model,  appear  explicitly 
in  the  final  controller  implementation.  A  more  detailed 
discussion  of  how  to  design  the  implicit  model  to  achieve 
robustness  is  included  in  Chapter  IV.  As  with  the  previous 
three  models,  the  specific  form  of  the  implicit  model  is  a 
function  of  CGTPIF  requirements  (16) ,  and  is  given  by; 

ir(t)  =FJyI(t)  (3-18) 

where 

n^.  =  number  of  implicit  model  states 

rj  =  number  of  implicit  model  inputs 

pj  =  number  of  implicit  model  outputs 

It  cannot  be  overemphasized  that,  although  implicit  and 
explicit  models  have  the  same  basic  structure  and  share  the 
same  input  routine  in  CGTPIF,  they  are  not  the  same  model, 
they  can  and  should  serve  different  purposes,  and  they 
need  not  be  related  in  any  way. 
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This  section  is  intended  to  give  the  reader  a 
qualitative  understanding  of  the  models  used  in  this  thesis 
It  is  basically  a  "bridge"  from  the  theoretical  modeling 
developments  in  Chapter  II  to  the  complete  and  detailed 
models  presented  in  Chapter  V.  Therefore,  this  section 
does  not  stand  alone  as  a  complete  development  of  models 
relevant  to  this  thesis;  however,  coupled  with  the  devel¬ 
opments  in  Chapters  II  and  V,  the  reader  should  transition 
from  a  theoretical  understanding  to  a  qualitative  "feel" 
to  a  complete  understanding  of  the  specific  CGTPIF- 
oriented  models  as  they  pertain  to  the  STOL  F-15  aircraft. 

3.4  The  STOL  F-15  Flight  Envelope 

As  stated  in  the  previous  section,  CGTPIF  allows 
for  a  performance  analysis  of  completed  controllers  by  use 
of  a  truth  model  to  represent  the  "real  world"  character¬ 
istics  of  the  system  being  controlled.  To  be  more  specific 
it  allows  analysis  of  the  full-state  feedback  controller 
and  a  separate  analysis  of  the  Kalman  Filter,  but  it  does 
not  provide  for  analysis  of  the  total  controller  as  a 
cascade  of  these  two  components.  Another  CAD  package 
called  PERFEVAL  is  available  which  allows  for  a  performance 
analysis  of  a  Kalman  Filter  based  CGT/PI  controller  (17) . 
This  software  capability  is  exploited  not  only  to  evaluate 
the  controller  designs  at  the  nominal  design  conditions  of 
Mach  0.9  at  20,000  feet  altitude,  but  also  to  evaluate  the 


60 


robustness  of  the  controller  throughout  the  combat  opera¬ 
tion  range  of  the  STOL  F-15,  and  to  evaluate  control  system 
robustness  in  the  face  of  variations  in  stability  deriva¬ 
tives,  surface  failures,  mismodeled  actuator  dynamics, 
etc.  See  Figure  3.1  for  a  depiction  of  the  flight  condi¬ 
tions  being  considered  in  this  thesis.  The  motivation  for 
designing  a  robust  system  with  the  capability  to  operate 
over  a  large  portion  of  the  STOL  F-15's  flight  envelope  is 
two-fold.  First,  a  control  system  which  does  not  require 
extensive  gain  scheduling  or  real  time  parameter  estimation 
for  adjustment  to  changes  in  operating  conditions  greatly 
reduces  the  complexity  of  the  control  system.  This  reduc¬ 
tion  in  controller  complexity  not  only  reduces  the  computa¬ 
tional  loading  of  the  on-board  flight  computer  system,  but 
reduces  the  physical  space  requirements  and  weight  require¬ 
ments  of  the  controller  as  well.  Second,  a  system  which 
can  at  least  maintain  stability  in  the  face  of  parameter 
variations  could  be  a  first  step  in  a  reconf igurable  con¬ 
trol  system  (i.e.  a  robust  law  to  hold  the  aircraft  in  the 
air  while  reconfiguration  is  accomplished) ,  capable  of 
greatly  enhancing  the  survivability  of  the  STOL  F-15  in 
the  face  of  combat  damage. 

In  order  to  construct  the  truth  models  used  to 
represent  the  variations  in  the  dynamics  of  the  STOL  F-15 
as  the  aircraft  progresses  through  its  flight  envelope,  it 
is  necessary  to:  a)  vary  the  entries  uniformly  in  the  truth 


model  which  represent  the  aircraft's  dynamics  by  a  set 
percentage  according  to  what  degree  the  flight  condition 
is  to  be  varied;  b)  use  data,  linearized  at  flight  condi¬ 
tions  which  lie  on  or  close  to  the  boundaries  of  the  flight 
envelope  which  the  controller  is  to  operate  within,  to 
derive  new  equations  of  motion;  c)  inject  noise  into 
the  truth  model  states  which  are  likely  to  be  mismodeled 
or  subject  to  variations;  or  d)  re-derive  the  aircraft 
equations  to  include  possible  failures  such  as  partial  or 
total  loss  of  actuators.  All  of  these  techniques  are  dis¬ 
cussed  in  Chapter  V. 

The  STOL  F-15's  flight  envelope  is  depicted  in 
Figure  3.1.  The  conditions  which  are  used  to  construct 
off-design  conditions  are  shown  as  boxes,  while  the  nominal 
design  condition,  which  is  chosen  as  representative  of  the 
"standard"  flight  condition  for  entering  into  air-to-air 
combat  (22),  is  depicted  as  a  triangle. 


3 . 5  Summary 

This  chapter  has  introduced  several  important  con¬ 
cepts  related  to  modeling  the  STOL  F-15  aircraft,  with  the 
goal  of  using  these  models  to  construct  CGT/PI  and  CGT/R 
control  laws.  In  Section  3.2  the  basic  assumptions  made 
in  order  to  produce  time  invariant,  linearized,  decoupled 
equations  of  motion  are  discussed.  Section  3.3  introduced 
the  form  of  the  dynamics  equations  which  are  motivated  by 
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the  CGTPIF  (7;  16)  CAD  package  which  is  used  to  generate 
the  controllers  of  Chapter  V.  Also,  a  software  package 
called  PERFEVAL  (17)  is  introduced  in  order  to  analyze  the 
Kalman- filter-based  controllers  designed  using  CGTPIF  (see 
Appendix  D) .  The  purpose  of  Section  3.4  was  to  justify  the 
points  in  the  flight  envelope  used  as  variant  operating 
conditions  for  analyzing  the  robustness  of  the  control 
systems  generated  during  the  course  of  this  thesis  effort. 
It  is  important  for  the  reader  to  realize  that  this  chapter 
is  not  intended  as  a  comprehensive  explanation  of  modeling 
the  STOL  F-15  aircraft,  but  rather  a  transition  to  provide 
familiarization  with  the  types  of  models  and  terminology 
which  are  used  extensively  in  Chapter  V. 
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Robustness  Enhancement  Techniques 
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4 . 1  Introduction 

The  concepts  and  methods  of  robustness  enhancement 
techniques  used  in  this  thesis  are  discussed  in  this  chapter. 
Two  specific  types  of  robustness  techniques  are  addressed. 
First,  implicit  model  following  techniques  are  presented. 
Implicit  model  following  controllers  were  initially  pre¬ 
sented  in  Section  3.4,  but  in  this  section  the  implicit 
model  following  technique  will  briefly  be  re-examined  in 
the  light  of  its  impact  on  closed-loop  full-state  feedback 
system  robustness.  Secondly,  the  Loop  Transfer  Recovery 
(LTR)  technique  will  be  developed  and  shown  to  provide 
asymptotic  full-state  feedback  system  robustness  character¬ 
istics  to  Kalman-filter-based  controllers. 

4.2  Implicit  Model  Following 

The  derivation  of  the  implicit  model  following  tech¬ 
nique  is  contained  in  Section  3.4,  so  this  section  will  not 
be  oriented  towards  mathematical  rigor.  Instead,  the  objec¬ 
tive  of  this  section  is  to  introduce  the  reader  to  some  of 
the  qualitative  aspects  of  using  the  implicit  model  con¬ 
troller  as  a  robustness  enhancement  technique  without 
mathematical  proof. 
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Recall  from  Section  3.4  the  implicit  model  follow¬ 
ing  controller  is  based  on  an  implicit  model  of  the  form 

ij(t)  =  FlZl(t)  (4-1) 

with  a  cost  function  constructed  by  weighting  the  following 
difference: 

e(t)  =  y(t)  -  Fjylt)  (4-2) 

along  with  a  quadratic  penalty  on  control  values,  where  y 
is  the  output  vector  associated  with  the  plant.  Thus  the 
objective  is  to  force  the  plant  to  adopt  dynamics  as 
described  by  the  implicit  model  matrix. 

The  question  which  needs  to  be  asked  is,  how  should 
the  implicit  model  be  chosen  in  order  to  improve  the 
overall  robustness  characteristics  of  the  system?  In  the 
case  of  the  explicit  model,  which  has  no  effect  on  robust¬ 
ness,  it  is  apparent  that  the  model  should  produce  outputs 
which  follow  a  desirable  trajectory  for  the  actual  plant 
outputs  to  emulate.  However,  by  examining  Equation  (4-2), 
it  can  be  seen  that  the  implicit  model,  unlike  the  explicit 
model,  is  used  in  its  complete  dynamical  form  in  the  cost 
function  definition.  Therefore,  the  state  matrix  is 
used  along  with  the  output  variables  of  the  actual  system 
to  define  a  cost  function  for  developing  the  feedback  con¬ 
trol  via  LQ  methods.  The  F^  matrix  can  be  thought  of  as 
embedding  the  desired  characteristic  equation  properties 
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of  the  controlled  variables  into  the  definition  of  the  cost 
function.  Therefore,  the  implicit  model  provides  the 
ability  to  carry  out  classical  "pole  placement"  in  a  MIMO 
design  using  powerful  LQ  synthesis  techniques. 

The  preceding  discussion  defines  a  classical  con¬ 
trol  theory  parallel  to  implicit  model  following;  however, 
it  does  not  specifically  address  the  robustness  issue. 

The  pole  placement  concept  can  be  exploited  to  this  end. 
Consider  an  aircraft  controller  design  based  on  a  reduced- 
order  model  of  a  system,  with  order  reduction  carried  out 
by  ignoring  actuator  dynamics  considered  to  be  beyond  the 
bandwidth  of  the  controller.  Using  LQ  synthesis  techniques, 
a  regulator  or  PI  controller  (see  Sections  2.2  and  2.3)  can 
be  designed  based  upon  this  reduced  order  model.  If,  upon 
completion  of  the  controller  design,  it  is  found  that  the 
desired  bandwidth  constraints  are  violated,  the  unmodeled 
actuator  dynamics  may  be  excited,  resulting  in  system 
instability;  i.e.  the  controller  is  not  "robust"  in  the  face 
of  unmodeled  higher  order  dynamics.  The  inclusion  of 
an  implicit  model  in  the  cost  function  used  to  derive  the 
previously  discussed  controller  provides  the  designer  with 
a  means  to  place  a  quadratic  penalty  on  the  deviation  of 
Equation  (4-2)  from  zero,  thus  penalizing  deviations  of 
the  output  variables  from  behavior  which  is  dictated  by  the 
characteristic  equation  defined  by  Fj  in  Equation  (4-2) . 
Therefore,  F  may  be  chosen  to  "place"  the  poles  of  the 


controller,  providing  a  means  to  reduce  the  system  band¬ 
width  and  robustify  the  controller  against  ignored  higher 
order  dynamics.  In  terms  of  the  classical  root  locus,  the 
designer  should  place  the  desired  poles  of  the  system  far 
enough  from  the  unmodeled  poles  that  "unexpected"  movement 
of  these  unmodeled  poles  will  have  the  least  possible 
effect  on  the  stability  of  the  overall  system  (14).  It 
has  also  been  shown  that  if  the  eigenvectors  of  the  desired 
system  model  are  nearly  orthogonal,  the  robustness  charac¬ 
teristics  of  the  closed  system  are  improved  (14) . 


4 . 3  Loop  Transfer  Recovery 

Recall  that  by  invoking  certainty  equivalence,  the 
LQ  controller  design  can  be  carried  out  under  the  assump¬ 
tion  of  full  state  availability.  Then,  once  the  final 
design  is  complete,  the  full  state  feedback  may  be  replaced 
with  a  Kalman  filter.  Intrinsic  to  the  LQ  full-state  feed¬ 
back  controllers  are  certain  guaranteed  minimal  stability 
robustness  properties  at  design  conditions  (13;  22)  . 
Further,  as  discussed  in  the  previous  section,  robustness 
of  the  full  state  system  to  unmodeled  plant  dynamics  can 
be  accomplished  using  implicit  modeling  techniques.  How¬ 
ever,  this  overall  robustness  achieved  in  the  full  state 
design  is  found  to  be  degraded  when  the  Kalman  filter  is 
incorporated  into  the  controller  (5;  22).  in  this  section 
a  method  known  as  Loop  Transfer  Recovery  (LTR)  will  be 


introduced,  which  is  able  to  accomplish  asymptotic  recovery 
of  the  full  state  robustness  characteristics.  Unless  other¬ 
wise  stated, the  following  development  is  taken  from  Refer¬ 
ence  14;  however,  for  a  more  detailed  discussion  the  reader 
is  directed  to  References  5,  9,  and  22. 

The  LTR  method  is  a  means  of  "tuning"  the  Kalman 
filter  used  to  provide  state  estimates  in  order  to  improve 
the  robustness  characteristics  of  the  overall  closed  loop 
system.  The  LTR  technique  cannot  improve  the  robustness  of 
the  controller  beyond  that  of  the  full  state  feedback  sys¬ 
tem;  however,  it  can  provide  robustness  up  to  and  asymp¬ 
totically  including  that  of  the  original  system.  The  objec¬ 
tive  of  the  LTR  technique  is  to  tune  the  Kalman  filter  in 
such  a  manner  that  the  return  difference  function  (9;  22) 
of  the  filter-based  controller  becomes  asymptotically  equal 
to  the  return  difference  function  of  the  full-state-feedback- 
system.  Recall  the  dynamical  system  equation 

x(t)  =  Fbc(t)  +  Bu  { t)  +  Gw  ( t)  (4-3) 

For  a  continuous-time,  minimum  phase  system  the  LTR  tuning 
is  based  on  the  following  equation: 

QLTR(q)  =  20  +  q2BVBT  (4-4) 

where  Qq  is  the  strength  of  the  dynamics  noise  in  the 
filter  before  LTR  tuning  is  applied,  and  V  is  any  positive 
definite  matrix  (commonly  chosen  to  be  the  identity 


matrix  _I)  .  The  robustness  of  the  LTR-tuned  filter/con¬ 
troller  approaches  that  of  the  full-state-feedback-system 
as  the  scalar  q  approaches  infinity.  The  physical  inter¬ 
pretation  of  Equation  (4-4)  is  a  process  of  injecting  noise 
into  the  input  channels  of  the  system,  i.e.  additional  white 
noise  is  added  to  the  system  model  at  the  same  points  of 
entry  as  used  by  the  control  inputs  u(t) . 

The  discrete-time  formulation  of  the  LTR  technique 
is  an  extension  of  the  continuous-time  case  made  by  any 
one  of  the  following  methods:  1)  completing  the  entire 
controller  design  in  the  continuous- time  domain,  including 
the  LTR  tuning,  and  discretizing  the  resulting  design; 

2)  performing  the  LTR  tuning  on  the  continuous-time  system, 
obtaining  the  equivalent  discrete  time  system  model,  and 
proceeding  to  apply  LQG  design  techniques  to  the  discrete 
time  system;  or  3)  obtaining  the  discrete-time  model  of 
the  system,  carry  out  the  LQG  design,  and  then  inject  white 
noise  into  the  entry  points  of  u(t).  The  white  noise  which 
is  injected  into  the  system  can  be  replaced  by  a  time  cor¬ 
related  noise  if  robustness  enhancement  is  required  over  a 
particular  frequency  range  (9);  however,  this  technique  will 
not  be  pursued  in  this  thesis.  Also,  it  has  been  shown  that 
a  dual  LTR  tuning  technique  exists  that  recovers  the  full- 
state-feedback  robustness  characteristics  of  the  system  by 
adjusting  the  weighting  matrices  of  the  LQ  regulator  (21) . 


However,  for  the  purposes  of  this  thesis,  attention  will 
be  limited  to  the  technique  introduced  in  Reference  22. 

Although  the  LTR  tuning  has  been  shown  to  provide 
more  enhanced  robustness  as  the  scalar  q  is  increased,  it 
also  allows  more  noise  to  be  passed  through  the  system. 

This  results  in  degraded  performance  at  design  conditions 
as  compared  to  the  non-LTR  tuned  controller.  Therefore, 
engineering  judgment  must  be  used  to  determine  the  proper  q 
which  provides  the  desired  balance  between  system  robustness 
and  controller  performance  at  design  conditions. 

4 . 4  Summary 

In  this  chapter,  two  robustness  enhancement  tech¬ 
niques  were  introduced.  First,  implicit  model  following 
was  presented.  This  scheme  was  shown  to  provide  robustness 
improvement  in  the  face  of  unmodeled  system  dynamics  by 
allowing  the  designer  to  invoke  pole  placement,  system 
bandwidth  rolloff,  and  eigenvector  orthogonalization  tech¬ 
niques  directly  in  an  LQG-synthesized  controller.  Secondly, 
the  LTR  technique  was  shown  to  be  a  tuning  method  which 
allows  the  full  state  robustness  characteristics  to  be 
recovered  asymptotically  when  a  filter  is  introduced  into 
the  loop  to  provide  state  estimates. 


The  preceding  development  is  meant  to  provide  engi¬ 
neering  insight,  not  detailed  mathematics.  The  reader  who 


desires  a  more  detailed  treatment  of  the  robustness  enhance 
ment  techniques  which  are  applicable  to  LQG  designs  is 
directed  to  References  5,  9,  13,  16,  21,  and  22. 


Experimental  Methods  and  Results 


5.1  Introduction 

An  analysis  of  the  design  work  accomplished  in  the 
course  of  this  thesis  effort,  along  with  a  presentation  of 
the  results  obtained,  will  be  the  topic  of  this  chapter. 
The  next  four  sections  of  this  chapter  derive  the  models 
for  the  longitudinal  mode  dynamics  of  the  STOL  F-15  (see 
Chapter  III),  followed  by  a  section  on  pitch  pointing  con¬ 
troller  design.  Section  5.7  will  present  the  methods  used 
to  test  control  system  robustness,  both  with  and  without 
a  Kalman  filter  embedded  in  the  control  system.  Finally, 
Section  5.8  summarizes  the  preceding  sections. 

The  reader  is  assumed  to  have  read  Chapters  III 
and  IV,  and  at  least  "scanned"  Chapter  II  (especially  Sec¬ 
tions  2. 3-2. 5)  before  embarking  on  this  chapter.  This 
preparation  is  necessary  since  much  of  the  material  dis¬ 
cussed  in  these  previous  chapters  will  be  referenced  in 
this  chapter  without  further  explanation. 


5 . 2  Detailed  Portrayal 

of  Design  Model 

As  discussed  in  Chapter  III,  the  linearized  longi¬ 
tudinal  equations  of  motion  for  the  STOL  F-15  are  of  the 
following  form: 


x(t)  =  Fx  ( t )  +  Bu ( t ) 


(5-1) 


where  the  state  vector  x(t)  consists  of  velocity  u(t), 
pitch  rate  q(t)  ,  angle  of  attack.  a(t)  ,  and  pitch  angle 
8(t).  Thus  Equation  (5-1)  becomes 


B13  4c(t> 

B23  SS{t) 
b33  [m*' 
B43  (5-2) 


where  6  ,  6  ,  and  6  are  the  inputs  which  drive  the  canard, 
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stabilator,  and  throttle,  respectively.  The  numerical  value 
of  the  coefficients  in  Equation  (5-1)  for  a  STOL  F-15  at  a 
velocity  of  mach  0.9  and  an  altitude  of  20,000  feet  are 
computed  by  STOLCAT  using  aerodynamic  data  provided  by  McAir 


to  be 


-0.18 

-20 

27.9 

-32.19 

-.23xl0~3 

-1.99 

10.81 

0 

-.35xl0"6 

.999 

-1.45 

-.73x10 

0 

1 

0 

0 

(5-3) 


For  numerical  values  of  the  F  and  B  matrices  in  Equation 
(5-1)  at  flight  conditions  other  than  that  of  Equation  (5-3) , 
see  Appendix  B. 


For  reasons  which  will  be  discussed  in  Section  5.4, 
the  output  variables  were  chosen  to  be 


Y(t)  =  Cx  ( t) 


Y  ( t) 

e  (t) 
q  (t) 


(5-4) 


where  y  (t)  is  flight  path  angle.  Using  the  approximation 


0  =  a  +  y 


(5-5) 


the  C  matrix  of  Equation  (5-4)  is  determined  to  be 


C  = 


0  0 
0  0 
0  1 


-1  1 

0  1 

0  0 


(5-6) 


(Note  that  during  the  course  of  the  research  con¬ 
ducted  in  conjunction  with  this  thesis,  a  nonlinear  dynamical 
equation  of  motion  for  the  STOL  F-15  was  derived  which 
allowed  for  the  simultaneous  control  of  both  thrust  and 
nozzle  deflection.  See  Appendix  D  for  a  discussion  of  this 
model  and  problems  encountered  in  its  implementation  for 
controller  design.) 


All  controllers  presented  in  this  chapter  are 
designed  based  on  this  four-state  design  model  in  order  to 


keep  controller  complexity  to  a  minimum.  However,  for 
performance  analysis  of  these  designs,  a  more  complex  "truth 
model"  will  need  to  be  derived.  This  truth  model  is  the 
subject  of  the  following  section  in  this  chapter. 


5 . 3  Truth  Model  Specification 

The  truth  model  derivation  begins  with  the  four- 
state  aircraft  model  presented  in  Section  5.2.  In  order  to 
provide  a  more  complete  aircraft  model,  actuator  dynamics 
states  were  augmented  to  these  original  system  states. 

The  dynamics  associated  with  the  canard  and  the  stabilator 
actuators  were  given  by  McAir  to  be  of  the  following  form: 


Vs)  =  6C(S)  ^  Ms] 

ei  (s) 


e,  (s) 

6S 


30.62  (272.7) 


e6(s)  (s+30.62) (s2+277. 2s+74474) 


(5-7) 


where  er  is  the  commanded  value  of  6.  The  associated  state 


space  representation  is: 
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Also,  first  order  actuator  dynamics  for  the  throttle 
dynamics  were  approximated  using  the  first  order  lag 
response 
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s  +  20 


or,  in  state  space  form 


6T(t)  =  25  6(t)  +  20  e5  (t) 


(5-10) 


With  these  states  augmented  to  the  original  system  states, 
the  resulting  truth  model  is  shown  in  Figure  5.1  on  the 
next  page. 

In  order  to  accomplish  a  reduction  in  the  complexity 
of  this  truth  model  to  lessen  the  computational  burden  with 
minimal  impact  on  truth  model  adequacy,  the  third  order 
actuator  dynamics  associated  with  the  canard  and  stabilator 
are  replaced  with  second  order  approximations  (10)  of  the 
form: 


Vs) 


6c(s) 


8356.2 


s  +303. 52s  +  8356.2 


When  represented  in  state  space  form  Equation  (5-11) 
becomes: 


-8356.2  -303.52  5 (t) 


5  (t) 


8356.2 


e6(t) 


(5-12 


As  can  be  seen  from  Figure  5.2,  this  is  an  accurate  approxi 


mation  over  the  bandwidth  of  interest  in  the  system.  The 
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truth  model  which  results  from  the  reduced  order  actuator 
dynamics  approximation  is  shown  in  Figure  5.3  on  the  next 
page . 

In  order  to  yield  the  same  output  variables  as  those 
found  in  Equation  (5-4),  the  C  matrix  for  the  truth  model 
of  Figure  5.3  is 
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Also,  the  T  matrix  discussed  in  Chapter  III,  which 
is  used  to  relate  the  states  of  the  truth  model  to  the 
states  of  the  design  model  for  CGTPIF  performance  evalua¬ 
tion  (7;  16)  ,  is 
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As  discussed  in  Chapter  III,  it  will  be  this  truth 
model  which  is  used  to  represent  the  "real  world"  charac¬ 
teristics  of  the  STOL  F-15  in  both  linear  and  nonlinear 
compute,*  analysis  of  the  pitch  pointing  controller 
presented  in  Section  5.7  of  this  chapter.  The  nonlineari¬ 
ties  of  the  latter  analysis  have  to  do  with  magnitude  and 
rate  saturations  of  the  actuators. 


This  ends  the  derivation  of  the  aerodynamic  data 
based  aircraft  models.  It  is  important  for  the  reader  to 
realize  that  the  design  and  truth  models  are  functions  of 
the  airframe  configuration  of  the  STOL  F-15  and  the 
actuator  dynamics  associated  with  the  servos  which  drive 
its  control  surfaces;  however,  the  models  which  are  pre¬ 
sented  in  the  following  two  sections  are  not  directly  tied 
to  the  physical  properties  of  the  aircraft  itself.  Instead, 
they  are  derived  by  the  designer  based  on  the  desired  per¬ 
formance  characteristics  of  the  controller. 

5.4  Explicit  Model  Derivation 

Unlike  the  two  previously  presented  models,  the 
explicit  model  is  not  based  on  provided  aerodynamic  data. 
Instead,  it  is  completely  determined  by  the  control  system 
designer  based,  in  this  case,  on  the  desired  aircraft 
handling  qualities.  The  first  step  which  was  taken  in 
deriving  this  model  was  to  define  the  system  outputs  needed 
in  order  to  accomplish  the  pitch  pointing  maneuver.  Since 
pitch  pointing  entails  decoupling  pitch  angle  and  flight 
path,  these  two  angles  are  obvious  candidates  for  output 
variables.  As  stated  in  Chapter  III,  the  design  software 
(7;  16)  requires  that  the  number  of  outputs  be  equal  to  the 
number  of  inputs,  which  in  this  case  is  3.  Therefore,  one 
output  variable  remains  to  be  chosen.  Based  on  previous 
work  in  this  area,  the  third  output  variable  was  chosen  to 
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be  pitch  rate,  since  this  has  been  shown  to  increase  con¬ 
troller  stability  (7;  16). 


The  next  step  that  was  taken  after  the  output  vari¬ 
ables  were  defined,  was  to  establish  the  desired  trajector¬ 
ies  for  these  variables  to  follow.  It  was  to  this  end  that 
the  explicit  model  was  designed.  For  a  pitch  pointing 
maneuver,  the  flight  path  requires  no  states  in  the  explicit 
model,  since  this  output  variable  is  to  be  commanded  to  zero 
for  all  time.  This  can  be  simply  accomplished  by  "zeroing 
out"  the  row  in  the  explicit  model  output  matrix  which 
corresponds  to  the  flight  path  variable.  The  desired  tra¬ 
jectory  for  the  pitch  angle  was  expressed  using  a  second 
order  explicit  model  dynamics  of  the  following  form: 


X  ( t) 
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X  (t) 

0 

X  (t) 
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X  (t) 

+ 

WN 

(5-15) 

where  is  the  commanded  pitch  angle  step  change 

(0.035  radians  or  2  degrees  for  the  designs  analyzed  in  this 
study)  and  x(t)  is  the  desirable  model-achieved  pitch  angle. 
Note  that  5  and  wN  were  chosen  to  be  0.5  and  3  rad/sec 
respectively,  in  order  to  provide  the  type  damping  and 
natural  frequency  response  desired  by  fighter  aircraft 
pilots  (8) .  In  the  first  attempt  to  form  the  explicit 
model  for  pitch  rate,  a  first  order  model  was  used;  how¬ 
ever,  when  excited  by  a  step  input  (the  only  type  of 


command  input  available  in  CGTPIF) ,  the  first  order  model 
commanded  a  non-zero  steady  state  output  to  the  system. 
Although  the  dynamics  of  the  system  eventually  drove  the 
actual  pitch  rate  to  an  extremely  small  value  over  the 
6  second  time  period  examined  for  the  aircraft  responses 
in  the  combat  mode  of  operation,  they  were  not  exactly  zero. 
This  small  steady  state  error  in  pitch  xate  resulted  in  a 
constant  rate  of  change  in  the  control  surface  deflection 
and  overall  long-term  system  instability.  In  an  attempt  to 
alleviate  this  problem,  a  second  order  model  was  introduced 
for  pitch  rate.  This  model  is  of  the  same  basic  form  as 
Equation  (5-15).  However,  instead  of  taking  x  as  the  ideal 
trajectory  to  be  tracked,  x  was  used  since  this  value  would 
have  a  steady  state  value  of  exactly  zero.  Through  an 
iterative  process,  the  entry  in  the  B  matrix  which  corres¬ 
ponds  to  the  input  to  the  pitch  rate  model  was  adjusted  to 
achieve  the  best  tracking  of  the  command  model  outputs  by 
the  outputs  of  the  actual  system.  It  was  observed  that 
usually  the  best  results  were  obtained  when  the  value  of  the 
entry  in  the  B  matrix  for  a  second  order  system  was  about 
10-15  percent  larger  than  the  systems  natural  damping 
frequency,^*  The  damping  of  the  second  order  pitch  rate 
model  was  chosen  to  be  0.707  in  order  to  minimize  settling 
time  and,  as  discovered  by  empirical  observation,  the 
natural  frequency  which  achieved  best  overall  tracking  by 
the  actual  system  was  the  same  as  the  natural  frequency  of 


the  pitch  angle  model,  i.e.,  3  rad/ sec.  The  final  form  of 
the  explicit  model  based  on  the  above  derivation  is: 
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with  the  model  output  matrix 
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Figure  5.4,  next  page,  is  a  plot  of  the  time  histories  of 
these  "ideal"  responses. 


5.5  Implicit  Model  Derivation 

Like  the  explicit  model  discussed  in  the  previous 
section,  the  implicit  model  is  also  completely  dictated  by 
the  designer  based  on  the  specifications  to  be  met  by  the 
final  control  design.  For  the  purposes  of  the  design 
accomplished  in  this  thesis  effort,  the  implicit  model  was 
constructed  to  provide  system  robustness  in  the  face  of 
unmodeled  high  frequency  dynamics  of  the  system.  This 
robustness  enhancement  is  basically  a  high  frequency  "roll 
off"  effect  (see  Section  4.2). 


At  the  points  in  the  envelope  which  were  con¬ 


sidered  in  this  study  (see  Section  3.4),  aside  from  Mach 
0.3  at  20,000  ft  as  will  be  discussed  shortly,  the  implicit 
model  was  used  as  a  means  to  embed  bandwidth  reduction  into 
the  LQ  design  process.  For  all  of  these  flight  conditions, 
the  implicit  model  used  was  of  the  following  form: 
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(5-18) 


As  the  magnitudes  of  the  negative  numbers  along  the 
diagonal  of  Equation  (5-18)  were  reduced,  the  bandwidth  of 
the  system  was  also  reduced;  however,  if  these  entries  were 
made  too  small,  the  pitch  rate  displayed  an  oscillation. 

This  problem  can  be  explained  by  recalling  that  the  implicit 
model  can  be  thought  of  as  a  pole  placement  technique. 

Thus  as  the  entries  in  the  F^.  matrix  become  smaller  they 
drive  the  poles  of  the  system  towards  the  imaginary  axis 
in  the  s-plane  and  induce  neutral  system  stability. 

Based  on  the  above ,  it  can  be  seen  that  the 
implicit  model  is  desired  to  reduce  the  system  bandwidth. 
While  the  ability  to  limit  the  bandwidth  showed  to  be  a 
useful  application  for  the  implicit  model,  it  also  showed 
some  limited  ability;  in  fact,  to  speed  up  the  system  when 
working  at  the  mach  0.3  @  20,000  ft.  flight  condition. 


However,  this  "band-extension"  characteristic  showed  only 
flight  change  in  the  overall  response  of  the  system  at  this 
point  in  the  envelope.  This  is  attributed  to  the  fact  that 
while  the  implicit  model  can  artificially  slow  down  (i.e. 
reduce  the  bandwidth)  of  a  fast  system,  it  cannot  speed  up 
what  would  otherwise  be  a  sluggish  system  without  lowering 
the  weights  on  the  control  amplitudes  and  rates.  At  best, 
it  was  found  that  the  implicit  model  was  useful  to  "push" 
the  slower  flight  condition  to  the  limits  of  its  maximum 
bandwidth  capability.  This  was  accomplished  by  entering 
large  negative  entries  along  the  major  diagonal  of  the  F ^ 
matrix  in  the  implicit  model.  For  the  controller  designed 
at  Mach  0.3  at  20,000  ft,  it  was  found  that  the  implicit 
model  which  achieved  the  fastest  settling  to  an  initial 
condition  (where  an  initial  condition  is  defined  as  steady 
state  value  for  the  state  lasting  from  time  equal  to  -°° 
to  C  and  set  to  zero  at  time  0+)  without  introducing 
instability  was 


*j(t)  = 


-24  0  0 

0  -24  0 

0  0  -24 


Xj  (t) 


(5-19 


where  the  off-diagonal  terms  are  zero  for  reasons  dis¬ 


cussed  in  Section  4.2. 


Based  on  the  preceding  discussion,  it  can  be  stated 
that  the  implicit  model  is  extremely  useful  as  a  bandwidth 
reduction  technique  and  somewhat  useful  as  a  "band  exten¬ 
sion"  technique.  However,  for  both  applications  care  must 
be  taken  to  limit  the  magnitude  of  the  entries  in  the  F 
matrix  so  as  not  to  induce  system  instability. 

5.6  Pitch  Pointing  Controller  Design 

Through  use  of  the  advanced  control  surface  archi¬ 
tecture  used  on  the  STOL  F-15  (see  Chapter  III) ,  certain 
maneuvers  are  possible  which  cannot  be  performed  on  a  con¬ 
ventional  F-15  aircraft.  In  the  longitudinal  mode,  these 
maneuvers  consist  of  pitch  pointing  and  vertical  transla¬ 
tion,  the  former  of  which  will  be  the  subject  of  the  control 
design  presented  in  this  section.  The  characteristic  which 
separates  these  "enhanced"  maneuvers  from  conventional 
maneuvers  is  the  ability  to  use  control  surfaces  to  produce 
lift  while  driving  moments  to  zero,  i.e.,  to  generate 
"direct  lift"  (15:69,  72). 

Pitch  pointing  consists  of  pointing  the  aircraft's 
nose  up  or  down  while  maintaining  a  fixed  flight  path. 

This  maneuver  is  especially  useful  for  air-to-air  gunnery 
since  gun  sight  errors  may  be  easily  nulled  without 
changing  the  trajectory  of  the  aircraft.  In  terms  of 
angles  used  to  describe  the  longitudinal  orientation  of  the 
aircraft,  pitch  pointing  consists  of  commanding  the  flight 


path  angle  to  zero  while  simultaneously  commanding  a 
desired  pitch  angle.  A  second  maneuver  which  exploits  the 
direct  lift  capabilities  of  the  STOL  F-15  is  vertical  trans¬ 
lation;  however,  this  mode  of  flight  is  not  addressed  in 
this  thesis. 

The  first  step  which  was  taken  in  the  design  of  the 
pitch  pointing  controller  was  to  determine  the  weighting 
matrices  to  be  used  in  the  definition  of  the  cost  function 
used  to  derive  the  PI  control  law.  The  initial  attempt 
used  the  strategy  that  the  inverse  of  the  square  of  the 
maximum  variation  allowable  in  a  particular  variable  being 
weighted  would  serve  as  the  weighting  on  that  variable  (12) 
This  approximation  is  considered  reasonable  due  to  the 
fact  that,  if  all  variables  weighted  in  this  manner  reach 
maximum  allowable  values  simultaneously,  they  will  con¬ 
tribute  equivalent  amounts  to  the  cost,  so  that  the  con¬ 
troller  will  expend  equal  amounts  of  effort  on  all  channels 
This  weighting  scheme  is  depicted  in  Equations  (5-20)  to 
(5-22)  below: 

W  (i, i)  =  - - - 2  <5_20) 

m  [Maximum  Control  Surface  Deflection] 

for  the  weights  on  the  control  magnitudes,  as  in  Equation 
(2-19)  , 
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“u. 
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1 

2 

[Maximum  Control  Surface  Rate] 
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for  the  weights  on  the  control  rates,  as  in  Equation  (2-37) 
and 


W  (i,i)  = 


[Maximum  Allowable  Deviation  in  Output] ^ 


(5-22) 

for  the  weights  on  the  output  magnitudes,  as  in  Equation 
(2-18),  where  W(i,i)  is  the  (i,i)  element  of  the  diagonal 
weighting  matrix.  From  the  information  provided  by  McAir 
(20) ,  the  following  rate  and  deflection  limits  were 
obtained  for  the  canard  and  stabilator: 


Canard  Position  Limits  =  -35°;  +  15c 


Canard  Rate  Limit  =  2 3° /sec 


Stabilator  Position  Limits  =  -29°;  +15‘ 


Stabilator  Rate  Limit  =  46° /sec 


(5-23) 

(5-24) 

(5-25) 

(5-26) 


Based  on  Equations  (5-23)  to  (5-26),  the  magnitude  weight¬ 
ings  for  the  input  vector  u(t),  (recall  that  the  entries  of 


u  consist  of  5  ,  <5C,  and  <5  )  were  determined  to  be 
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in  Equation  (2-19),  and  the  rate  weights  were  determined 
to  be 
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2 

For  instance,  the  1,1  element  of  W  is  l/[.262  rad] 

m 

since  this  was  the  smaller  of  the  upper  and  lower  limits. 

Note  that  in  Equations  (5-27)  and  (5-28) ,  the  value  for 
weightings  on  throttle  input  magnitude  and  throttle  input 
rate  were  assumed  to  be  approximately  the  same  value  as 
the  other  weightings  in  these  weighting  matrices.  This 
assumption  was  made  based  simply  on  the  lack  of  any  quanti¬ 
tative  information  of  the  physical  limitations  of  the 
throttle  response  for  the  STOL  F-15  and  bears  further 
investigation . 

In  order  to  make  a  "first  cut"  derivation  of  the 
weighting  matrix  on  the  system  outputs,  y,  a  10.47  milli- 
radian  (0.6  degrees)  pitch  point  was  considered.  Assuming 
deviation  of  no  more  than  10  percent  yielded  a  maximum  allow¬ 
able  deviation  of  1.047  milliradians  (0.06  degrees).  In 
order  to  obtain  a  weighting  on  flight  path,  it  was  assumed 
that  the  flight  path  should  be  allowed  ten  times  less  devia¬ 
tion  than  pitch  angle,  i.e.,  0.1047  milliradians  (0.006 
degrees) .  Similarly,  the  pitch  rate  weight  was  initially 
set  based  on  the  weighting  of  pitch  angle  (since  these 
states  are  linearly  related  through  a  derivative).  Based 
on  these  assumptions  the  output  variable  weighting  matrix 
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becomes  (recalling  that  the  output  variables  are  y,  8 
and  q,  respectively) : 
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The  initial  designs  were  based  on  the  above  weighting 
matrices  and  the  explicit  model  of  Equation  (5-16) .  These 
controllers  showed  responses  almost  identical  to  those  of 
the  ideal  responses  when  tested  using  a  truth  model  which 
was  identical  to  the  design  model  for  evaluation  purposes; 
see  Figure  5.5  next  page  (compare  the  upper  portion  of 
Figure  5.5  to  the  ideal  response  of  Figure  5.4).  (Admittedly, 
this  is  a  questionable  practice  at  best.  However,  for  the 
purposes  of  this  study  all  designs  were  initially  tested 
against  the  four-state  design  model  for  the  purpose  of 
establishing  the  desired  characteristics  to  embed  in  the 
explicit  model  to  achieve  desirable  handling  qualities.  By 
no  means  were  these  evaluations  meant  to  yield  any  stability 
information  about  the  system.)  However,  when  the  truth  model 
varied  from  the  design  model,  the  system  designed  on  the 
basis  of  the  above  weightings  was  unstable,  both  with  and 
without  implicit  model  following  (see  the  lower  portion  of 
Figure  5.5).  The  desire  to  achieve  tight  control  over  the 
output  variables,  as  evidenced  by  Equation  (5-29),  proved 
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PITCH  POINTING/POOR  WEIGHTINGS/ACTUATORS 
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to  have  disastrous  effects  on  system  robustness.  It  was 
found  that  the  solution  to  this  problem  was  to  abandon  the 
"inverse-maximum  deviation-squared"  solution  to  the  weight¬ 
ing  matrices  in  favor  of  a  more  intuitive  approach. 

The  observation  was  made  that,  if  the  values  of  the 
weighting  matrix  determinants  differed  from  one  another 
appreciably  (by  approximately  more  than  two  orders  of  magni¬ 
tude)  ,  the  controller  designed  based  on  these  weights  would 
be  unstable  in  the  face  of  linear  second-order  actuator 
dynamics  in  the  truth  model.  Therefore,  the  diagonal 
entries  of  all  three  weighting  matrices  were  set  equal  to 
0.1  and  then  were  adjusted  iteratively  until  the  desired 
responses  were  achieved  with  a  nine-state  truth  model.  The 
thought  progression  for  determining  the  weights  which  needed 
to  be  changed  was  as  follows: 

1.  Starting  from  the  "equal-weighting"  condition 
of  0.1  along  the  diagonal  of  each  weighting  matrix,  the 
system  response  was  analyzed  against  the  four-state  truth 
model  (again,  this  was  not  a  test  of  system  robustness, 
but  rather,  a  test  of  acceptable  system  response  in  general) . 
If  a  rate  or  position  limit  was  violated  in  the  actuators, 
then  the  weight  associated  with  that  rate  or  magnitude  was 
increased  in  order  to  exert  more  restraint  over  that  vari¬ 
able,  and  thus  reduce  its  expenditure  of  control  energy. 
Interestingly,  the  weights  associated  with  the  output  vari¬ 
ables  needed  no  adjustment  at  this  time  since  the 
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Fig.  5.6.  Aircraft  Response  Without  (Upper)  and  With  (Lower)  Actuators/ 

Well  Chosen  Weighting  Matrices  ;  1  =  flight  path;  2  =  pitch  anqle 
3  =  pitch  rate 


trajectories  of  the  output  variables  were  close  to  the 
ideal  case  depicted  in  Figure  5.4  (compare  Figure  5.4  and 
the  upper  section  of  Figure  5.6). 


2.  At  this  point,  the  controller  was  tested  against 
the  9-state  linear  truth  model  of  Figure  5.3  and  the  system 
was  found  to  be  unstable.  In  order  to  stabilize  the  system, 
the  weights  on  the  output  variables  were  reduced  to  allow 
for  less  "tight  control"  of  these  variables  under  "off- 
design"  conditions.  It  was  found  that  this  procedure  did 
indeed  stabilize  the  system  in  the  face  of  actuator  dynamics; 
see  the  lower  portion  of  Figure  5.6.  It  was  also  observed 
that  the  pitch  rate  channel  was  by  far  the  best  indicator 

of  system  stability;  i.e. ,  when  the  system  was  near 
instability,  oscillations  would  appear  in  the  pitch  rate. 

Some  degree  of  this  oscillatory  behavior  continued  on  the 
pitch  rate  channel  despite  attempts  to  change  the  weighting 
of  the  controlled  variables;  see  the  lower  section  of 
Figure  5.7  on  the  next  page. 

3.  Finally,  the  implicit  model  of  Equation  (5-18) 
was  introduced  into  the  controller  design.  The  weightings 
on  magnitude  and  rate  variations  were  determined  using  the 
same  type  of  procedure  used  in  step  1  to  be; 
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Fig.  5.7.  Pitch  Rate  Channel  Poor  Implicit  Model  Weighting  (Lower) /Well  Chosen 
Implicit  Model  Weightings  (Upper) 


respectively.  The  criterion  for  acceptable  performance  was 
reduced  ringing  in  the  pitch  rate  channel  when  tested 
against  the  nine- state  truth  model,  as  shown  in  the  upper 
section  of  Figure  5.7. 

Based  on  steps  1  and  2,  the  weighting  matrices  of 
Equations  (5-27)  to  (5-29)  were  adjusted  to  be  (see  Figure 
5.6  and  the  upper  portion  of  Figure  5.7  for  the  aircraft 
responses  using  these  weightings) : 


The  above  process  was  carried  out  for  the  four  flight  con¬ 
ditions  presented  in  Section  3.4,  and  stabilized  con¬ 
trollers  were  obtained  at  these  flight  conditions  when 
tested  against  a  nine-state  truth  model.  All  designs 
were  achieved  using  the  same  weighting  matrices,  explicit 
model,  and  implicit  model  (except  for  the  implicit  model 
used  at  Mach  0.3  at  20,000  ft.,  as  discussed  in  Section  5.5) 
Therefore,  the  results  presented  for  this  thesis  will  be 
those  at  the  "nominal"  flight  condition  of  Mach  0.9  at 
20,000  ft.,  since  this  is  representative  of  both  the  results 
and  design  methodologies  used  at  all  flight  conditions. 

The  final  controller  was  designed  based  on  the  pre¬ 
viously  described  weighting  matrices  and  the  implicit  and 
explicit  models  of  Equations  (5-16)  and  (5-18) .  The 
resulting  gain  matrices  (see  Section  3.5,  especially  Equa¬ 
tion  (2-79))  were  generated  using  CGTPIF  (7;  16): 
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(5-38) 


The  responses  to  a  0.035  radian  (2  degrees)  pitch 
point  command  for  a  controller  based  on  Equation  (2-79) 
with  the  gain  matrices  of  Equations  (5-35)  to  (5-38)  are 
shown  for  both  a  four- state  truth  model.  Figure  5.8,  and 
a  nine-state  truth  model.  Figure  5.9,  on  the  following 
pages.  Note  that  in  both  cases  the  aircraft  responses  are 
close  to  those  of  Figure  5.4.  However,  for  the  nine-state 
case  a  slight  ringing  occurs  in  the  pitch  rate  channel; 
this  is  due  to  the  instabilities  introduced  by  including 
the  actuators  in  the  truth  model  while  maintaining  a  four- 
state  design  model.  This  ringing  appears  pronounced  due  to 
the  common  scaling  of  the  output  variables.  However,  this 
is  actually  an  acceptable  response  as  evidenced  by  the 
pitch  angle  and  flight  path  channels;  i.e.,  the  pitch 
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Fig.  5.9.  Aircraft  Response  with  Actuators 
a.  Aircraft  responses;  b.  Control  deflections 
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pointing  maneuver  itself  is  accomplished  well  despite  the 
time  lags  introduced  by  the  actuator  dynamics. 


Once  the  full- state  controller  design  was  complete, 
a  constant-gain  Kalman  filter  was  separately  designed  to 
replace  the  assumption  of  full  state  availability  with 
state  estimates  based  upon  noise-corrupted  partial  state 
availability.  The  measurements  were  modeled  to  be  of  the 
following  form: 


z(t.)  =  H  x  ( t . )  +  v  ( t . ) 
—  1  - 1  —  1 

where 


(5-39) 


(5-40) 


The  covariance  of  the  measurement  noise,  v(t^) ,  was  taken 
from  Reference  7  to  be 


R  = 


476x10 

0 
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0 

.122x10 
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0 
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-4 


(5-41) 


In  this  development,  a  term  Gw(t)  was  added  to  the  dynamics 
state  equation,  with  w(t)  being  zero-mean  white  Gaussian 
noise,  independent  of  v(t^) ,  and  of  strength  Q  where 


0 


c 


G  = 


1 

1 


0 


Q  =  .001 


(5.42) 


This  form  of  Gw(t)  is  motivated  as  a  "first  cut"  at  intro¬ 
ducing  the  effects  of  wind  buffeting  on  the  aircraft  (8) . 
Using  CGTPIF  and  PERFEVAL  (7;  16;  17),  the  Kalman  filter 
gain  matrix  was  determined  to  be 
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(for  a  more  detailed  discussion  of  basic  Kalman  Filtering 
theory  the  reader  is  directed  to  Appendix  E  and  Refer¬ 
ence  11) .  The  pitch  pointing  maneuver  with  the  Kalman 
filter  in  the  loop  is  shown  in  Figure  5.10  on  the  next 
page.  In  order  to  account  for  unmodeled  time  lags  in  the 
system,  the  controller  was  also  tested  using  the  suboptimal 

A 

control  law  based  on  x(tT) .  This  form  of  the  control  law 
bases  the  control  input  to  the  system  on  the  Kalman  filter's 
best  estimate  of  the  system  states  before  the  actual  mea¬ 
surement  is  incorporated;  this  allows  u(t^)  to  be  computed 
before  time  t^  to  remove  computational  delay  time  of 
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computing  x(t^  )  and  then  the  control  u(t^)  based  on  this 
state  estimate.  This  response  is  shown  in  Figure  5.11. 

Note  that  the  responses  both  with  and  without  the  time  delay 
in  the  system  are  essentially  the  same.  Therefore,  the 
impact  of  using  this  subopt imal  control  law  is  minimal. 

Also  it  is  apparent  that  the  Kalman  filter  does  not 
degrade  the  ability  of  the  controller  to  achieve  the  pitch 
pointing  maneuver  within  a  3.5  second  time  interval. 

The  pitch  pointing  controller  design  presented  in 
this  section  has  been  shown  to  display  desirable  charac¬ 
teristics  when  tested  against  a  nine-state  truth  model, 
both  with  and  without  a  Kalman  filter  embedded  in  the  con¬ 
trol  law.  It  will  be  these  system  responses  which  will 
serve  as  a  baseline  for  the  robustness  analysis  discussed 
in  the  following  section. 

5.7  Robustness  Analysis 

The  pitch  pointing  controller  presented  in  the  pre¬ 
vious  section  was  shown  to  be  stable  when  evaluated  against 
a  nine-state  truth  model.  In  this  section  the  controller 
evaluation  will  be  extended  using  software  generated  spe¬ 
cifically  to  include  parameter  variation  and  nonlinear 
effects  such  as  control  surface  rate  and  position  limits 
(see  Appendix  C) .  Before  presenting  the  results  of  this 
robustness  analysis,  it  is  in  order  to  state  that  the 
parameter  variation  technique  which  is  employed  in  this 
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study  is  a  somewhat  limited  tool  for  establishing  system 
robustness.  A  more  precise  analytical  method  (5)  would 
include  structured  singular  value  analysis  to  provide  com¬ 
plete  information  about  the  system's  robustness  character¬ 
istics;  however,  this  approach  is  beyond  the  scope  of  this 
thesis.  The  plotted  data  corresponding  this  robustness 
analysis  are  contained  in  Appendix  F  of  this  thesis.  Also, 
it  should  be  noted  that,  for  the  majority  of  the  robustness 
analyses  presented  in  this  section,  actuator  rate  limits 
are  not  included.  This  is  due  to  the  fact  that  severe 
instabilities  were  induced  by  limiting  the  rates  to  those 
specified  in  the  previous  section.  However,  at  the  time 
of  this  writing,  there  exists  conflicting  information  about 
the  actual  rate  limitations  of  these  surfaces.  In  an 
attempt  to  make  a  "worst  case"  analysis,  the  lowest  rate 
limits  available  are  used  for  the  robustness  analysis  con¬ 
ducted  in  this  thesis. 

The  first  nonlinear  effect  which  was  introduced  into 
the  system  was  a  "sign  swapping"  routine  to  account  for  a 
problem  which  was  identified  with  the  linear  model  (1;  20) 
(see  Appendix  C  for  a  discussion  of  the  nonlinear  analysis 
program  ODEF15) .  The  problem  which  existed  was  that,  as 
the  control  surfaces  passed  through  zero  angle  of  attack 
relative  to  the  aircraft,  the  sign  of  the  coefficient  in 
the  B  matrix  which  corresponded  to  the  drag  induced  by  the 
control  surface  failed  to  change  sign.  Effectively,  this 


corresponded  to  a  system  which  could  increase  thrust  by 
increasing  the  deflection  of  the  control  surfaces.  Of 
course  this  is  a  completely  unrealistic  situation,  so  the 
sign  swapping  routine  is  included  in  all  of  the  following 
analyses  without  further  discussion.  Note  however  that, 
since  velocity  is  not  specifically  controlled  in  this 
design,  airspeed  is  not  held  constant  in  steady  state. 
Therefore,  throttle  deflection  may  actually  drop  in  a 
maneuver  which  requires  an  increase  in  thrust  in  order  to 
maintain  airspeed  (however,  this  drop  is  not  due  to  the 
linear  analysis  problem  of  experiencing  "negative  drag" 
since  the  sign  swapping  routine  was  being  employed  while 
this  problem  was  identified) .  This  phenomenon  is  not  a 
problem  over  the  six-second  period  determined  to  be  essen¬ 
tially  the  longest  period  that  the  pilot  would  fly  "hands- 
off"  in  the  flight  envelope  considered  in  this  study, 
since  the  airspeed  drops  less  than  1  percent  over  this  time 
period.  In  fact  it  is  common  practice  to  eliminate  velocity 
completely  from  the  dynamical  equations  of  motion  using  a 
short  period  approximation  (6),  thereby  completely  ignoring 
the  controller  impact  on  velocity. 

The  correct  way  to  address  this  problem  is  obvi¬ 
ously  to  place  a  quadratic  weight  on  velocity  and  exploit 
the  properties  of  the  PI  control  structure  (see  Chapter  II) 
to  assure  constant  steady  state  airspeed.  However,  due  to 
the  limitations  of  the  software  (7) ,  in  order  to  augment 
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velocity  to  the  system  outputs,  an  independent  control  must 
be  augmented  to  the  input  vector.  An  attempt  was  made  to 
introduce  a  new  control  input  by  incorporating  the  thrust 
vectoring  nozzles;  however,  nonlinearities  associated  with 
this  problem  were  severe  and  the  approach  was  abandoned 
(see  Appendix  D  for  a  derivation  of  this  nonlinear  model) . 

Another  attempt  to  provide  control  of  velocity  was 
made  by  introducing  velocity  into  the  existing  output 
vector.  First  pitch  rate  control  was  removed  and  replaced 
with  velocity  control.  This  approach  robbed  the  system  of 
a  significant  amount  of  its  robustness  characteristics. 

In  fact,  without  controlling  pitch  rate  the  system  could 
not  even  be  stabilized  against  in  the  face  of  second-order 
actuator  dynamics,  thus  validating  the  original  assumption 
that  pitch  rate  control  would  enhance  system  robustness. 

The  second  approach  attempted  to  drive  the  linear  combina¬ 
tion  of  velocity  and  flight  path  angle  to  zero.  This 
resulted  in  a  system  which  could  drive  the  combination  to 
zero;  however,  both  velocity  and  flight  path  angle  displayed 
steady  state  error  (as  expected) . 

Since  throttle  was  available  as  a  system  input, 
two  ad-hoc  techniques  were  derived  to  demonstrate  that  the 
throttle  input  could  be  used  to  maintain  airspeed  if  needed 
in  a  four-input/ four-output  system.  First  an  absolute 
value  function  was  placed  on  the  control  input  to  the 


throttle : 


and  e'  (t)  then  replaced  e.  (t)  in  Equation  (5-9).  This 

Oip  Oip 

approach  maintained  airspeed  for  a  two-degree  pitch  point¬ 
ing  maneuver;  however,  it  was  not  practical  for  varying 
commanded  pitch  angles.  In  order  to  address  this  problem, 
the  following  form  of  throttle  control  was  implemented: 

e"  (t)  =  -0.2  e.  (t)  (5-45 

6T  °c 

while  the  throttle  command  was  made  a  linear  function  of 
stabilator  deflection.  The  system  responses  using  these 
ad-hoc  techniques  are  shown  in  Figures  F.l  and  F.2  in 
Appendix  F. 

The  first  check  of  system  robustness  was  to  evalu¬ 
ate  how  well  the  system  could  withstand  variations  in  the 
F  matrix  of  Equation  (2-4).  In  order  to  establish  this, 
all  entries  were  varied  by  a  specific  amount  in  the  follow 
ing  form: 

*(  t)  =  (F+AF)x(t)  +  Bu(t)  (5-46 

The  system  was  found  to  be  able  to  display  acceptable 
response  with  the  variation  AF  being  up  to  100  percent  of 
the  matrix  F.  This  insensitivity  to  variation  in  F  is 
logical  since  the  original  aircraft  is  unstable  at  this 
flight  condition,  thereby  requiring  that  the  controller 


suppress  the  actual  dynamics  of  the  system.  Plots  of  10 
percent,  25  percent,  100  percent,  and  200  percent  increase 
in  F  in  Appendix  F  (F.3  to  F.6)  show  the  trend  of  reduction 
in  direct  lift  capability,  creating  flight  path  angle/pitch 
angle  coupling  as  AF  increases.  Also  note  that  at  200  per¬ 
cent  variation  in  F,  Figure  F.6,  the  pitch  rate  channel  is 
shown  to  be  the  leading  indicator  of  system  instability. 

Another  attempt  to  create  a  realistic  change  in 
aircraft  characteristics  was  accomplished  by  failing  the 
canard.  This  was  a  "free-floating"  failure  in  which  the 
canard  was  fixed  at  zero  angle  of  attack  in  relation  to  the 
relative  velocity  of  the  aircraft.  This  failure  resulted 
in  coupling  between  flight  path  and  pitch  angle,  which  is 
to  be  expected  since  a  failure  of  the  canard  removes  all 
direct  lift  capabilities.  See  Figure  F.7  for  the  full- 
state  feedback  aircraft  response  in  the  face  of  a  full 
canard  failure.  In  this  plot  it  is  shown  that  stability  is 
maintained  with  the  canard  failure;  however,  the  ability  to 
achieve  direct-lift  is  lost,  therefore  the  pitch  pointing 
maneuver  can  not  be  accomplished. 

In  order  to  address  a  common  problem  known  as 
windup,  which  can  affect  the  robustness  of  PI  type  con¬ 
trollers,  an  anti-windup  compensator  was  added  to  the  sys¬ 
tem.  Readers  who  desire  a  derivation  of  the  anti-windup 
compensator  presented  in  this  study  are  directed  to  Refer¬ 
ence  16.  Windup  occurs  when  a  PI  controller  encounters 


saturation  limit.  While  the  proportional  channel  will 
react  immediately  to  compensate  for  the  large  errors  which 
occur  as  a  satiration  is  encountered,  the  integral  channel 
will  build  up  to  a  large  control  output.  This  buildup  will 
continue  until  a  sign  change  occurs  in  the  input  to  the 
integral  channel,  even  after  the  error  in  the  system  has 
been  driven  back  to  a  small  value.  This  "out  of  phase" 
compensation  to  saturations  can  induce  system  oscillation 
and  instability.  The  anti-windup  compensator  reduces  the 
effect  of  this  phenomenon  by  placing  limits  on  the  value 
of  the  command  inputs  to  the  control  surfaces  of  the  air¬ 
craft.  This  precludes  sending  control  signals  which  can 
cause  these  surfaces  to  be  driven  into  saturation,  thereby 
eliminating  the  possibility  of  inducing  windup  in  the  system. 
In  some  cases  it  was  found  that  anti-windup  compensation, 
when  used  without  imposing  saturation  limits  on  the  control 
surfaces  in  the  truth  model,  could  cause  instability  because 
it  limited  the  control  available  to  the  system.  However, 
for  most  cases  the  anti-windup  compensator  showed  improved 
response.  Comparing  Figure  F.8  to  Figure  5.9  shows  that  the 
anti-windup  compensator  has  reduced  the  oscillation  in  the 
pitch  rate  channel  for  the  full-state  feedback  system  with 
actuator  limits.  Figures  F.9  and  F.10  show  the  aircraft 
responses  with  a  Kalman  filter  in  the  loop  and  with  a  Kalman 
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filter  with  control  based  on  x(t^),  respectively.  Notice 
that  these  responses  are  identical  to  Figures  5.10  and  5.11, 


indicating  that  for  these  controllers  the  saturation  limits 
are  never  reached  for  a  two-degree  pitch  pointing  maneuver. 

The  sensors  used  on  the  STOL  F-15  can  be  modeled 
using  second-order  dynamics  (20).  However,  since  these 
measurement  dynamics  were  not  included  in  the  truth  model, 
the  measurement  noise  was  increased  as  a  "first  cut"  at 
evaluating  the  systems  robustness  in  the  face  of  unmodeled 
sensor  dynamics  and  other  uncertainties.  Figure  F.ll  in 
Appendix  F  shows  the  effect  of  increasing  the  measurement 
noise  to  a  level  40  times  higher  than  that  given  in  Equa¬ 
tion  (5-41)  in  the  truth  model  without  changing  the  measure¬ 
ment  noise  level  used  to  design  the  Kalman  filter.  While 
the  system  maintained  stability  with  this  increased  measure¬ 
ment  noise,  it  can  be  seen  from  Figure  F.ll  that  this  con¬ 
dition  causes  increased  workload  on  the  control  surfaces. 

An  attempt  was  made  to  limit  this  overworking  of  the  control 
surfaces  by  using  anti-windup  control;  however,  as  evidenced 
in  Figures  F.12  and  F.13,  this  did  not  remove  the  flutter  in 
the  canard  and  stabilator. 

At  this  point  the  LTR  tuning  technique  was  introduced 
in  an  attempt  to  enhance  system  robustness  with  a  Kalman 
filter  in  the  loop  (see  Section  4.3).  Despite  exhaustive 
attempts  to  apply  this  technique,  it  was  found  that  for  all 
but  extremely  small  values  of  q  in  Equation  (4-4),  the  result 
was  system  instability.  The  system  was  finally  stabilized 
with  a  q  value  of  .00316.  The  analysis  technique  used  in 


this  thesis  is  severely  limited  in  its  regard  to  quantify 
the  increase  in  system  robustness  using  the  LTR  technique. 
First  of  all,  just  how  much  of  the  full  state  robustness 
was  lost  by  introduction  of  a  Kalman  filter?  If  the 
original  Kalman  filter-based  controller  was  already  near  the 
robustness  levels  of  the  full  state  system,  the  applica¬ 
tion  of  an  LTR  technique  might  be  a  waste  of  time.  On  the 
other  hand,  if  serious  robustness  degradation  has  been 
introduced  by  the  loss  of  full  state  availability,  there  is 
no  way  to  measure  how  much  has  been  gained  in  the  way  of 
system  robustness  with  the  LTR  technique,  i.e. ,  when  is  the 
point  of  diminishing  returns  reached  as  q  is  increased 
further  and  further?  Without  the  ability  to  apply  struc¬ 
tured  singular  value  analysis,  the  LTR  technique  generated 
more  questions  than  answers.  However,  attempts  were  made  to 
analyze  the  impact  of  applying  the  LTR  technique  despite 
these  shortcomings  in  the  analytical  approach  available  for 
this  research. 

In  order  to  establish  a  standard  by  which  to  judge 
the  LTR-tuned  controller,  white  Gaussian  noise  was  injected 
into  the  pitch  rate  and  angle  of  attack  channels  in  the 
truth  model  without  changing  the  original  controller  design, 
in  order  to  produce  visible  instability  in  the  system. 

This  process  noise  was  made  large  enough  (Q  =  .08)  to  have 
a  marked  impact  on  the  system,  as  shown  in  Figure  F.14. 

Once  this  "high-noise"  baseline  was  established,  the  LTR 


tuning  technique  was  applied  to  the  control  system  in  an 
effort  to  identify  any  improvement  (i.e.  less  oscillatory 
behavior)  in  the  face  of  high  noise  injection  in  the  truth 
model.  From  the  response  of  the  system  with  LTR  tuning. 
Figure  F.15  in  Appendix  F,  it  can  be  seen  that  some  reduc¬ 
tion  in  oscillatory  behavior  of  the  system  is  achieved. 
However,  this  result  is  in  no  way  intended  to  provide  con¬ 
clusive  information  of  the  application  of  the  LTR  technique; 
to  the  contrary,  it  would  be  less  than  technically  correct 
to  draw  any  conclusions  from  the  application  of  LTR  tuning 
on  the  basis  of  this  admittedly  limited  analysis  of  the 
technique . 

As  a  final  attempt  to  try  a  tuning  approach  to 
increase  the  system  robustness  with  the  Kalman  filter  in 
the  loop,  an  ad-hoc  method  was  attempted  based  on  the  fol¬ 
lowing; 

Q(q)  =  20  +  q2CTC  (5-47) 

where  all  the  variables  are  the  same  as  those  presented  in 
Section  4.3  for  LTR  tuning  except  for  C  which  is  the  out¬ 
put  matrix  of  Equation  (2-8).  Based  on  the  observation 
that  pitch  rate  is  the  most  sensitive  channel  to  parameter 
variation,  the  "C- tuned"  system  was  tested  using  vari¬ 
ations  in  the  B  matrix  of  Equation  (2-4)  .  The  stability 

derivatives  M,  and  M,  were  independently  varied,  both  with 
C  S 

and  without  C-tuning.  The  results  shown  in  Table  5.1 


TABLE  5.1 


EFFECT  OF  C-TUNING  FILTER 


With  C  Tuning 

Without  C  Tuning 

M, 

6C 

M, 

6s 

M. 

6S 

Percent  Increase 
in  Stability 
Derivative 

16% 

16% 

7% 

10% 

Percent  Decrease 
in  Stability 
Derivative 

100% 

40% 

100% 

7% 

indicate  that  a  substantial  increase  in  system  robustness 
is  achieved.  Plotted  responses  of  the  C-tuned  system  are 
given  in  Appendix  F,  Figures  F.16  through  F.23.  In 
Figure  F.16  the  full-state  feedback  system  response  with 
actuators  is  shown.  It  can  be  seen  from  this  figure  that 
the  pitch  rate  channel  exhibits  no  oscillation,  as  com¬ 
pared  to  Figures  5.9  and  F.8,  indicating  increased  system 
stability.  However,  the  settling  time  is  increased  from  4.5 
seconds  to  over  6  seconds.  This  type  of  tradeoff  between 
robustness  and  response  characteristics  is  indicative  of 
LTR  tuning  scheme's  characteristics  (22).  In  Figure  F.17 
the  aircraft  response  is  shown  with  rate  limits  included  in 
the  truth  model.  Without  C-tuning,  imposing  rate  limits 
on  the  actuators  drove  the  system  into  instability  even  in 
the  full-state  feedback  system  without  actuators;  however, 
when  C-tuning  was  employed,  the  system  was  stable  with  not 


only  rate  limits  but  with  actuators,  position  limits,  a 

Kalman  filter  in  the  loop,  and  a  time  lag  simultaneously 

introduced  in  the  truth  model  as  well  (see  Figure  F.17). 

While  stability  is  maintained,  an  effective  steady-state 

error  is  incurred  over  the  6-second  time  period,  as  shown 

in  the  figure.  Comparing  Figure  F.18  to  Figure  F.6  shows 

that,  with  C- tuning  the  system  is  stabilized  in  the  face  of 

a  200  percent  additive  increase  in  the  F  matrix  (as  compared 

to  100  percent  for  the  non-C-tuned  system  of  Figure  F.5). 

Figure  F.19  shows  the  C-tuned  system  response  in  the  face 

of  a  40-fold  increase  in  measurement  noise  in  the  truth 

model.  Comparing  this  response  to  that  of  Figures  F.ll, 

F . 12 ,  and  F.13  shows  that  the  control  surface  flutter  is 

suppressed  in  the  C-tuned  system.  The  aircraft  responses 

for  variations  in  the  B  matrix  stability  derivatives, 

Mx  and  Mt  (see  Table  5.1)  are  shown  in  Figures  F.19 
6C  6S 

through  F.23.  It  should  be  noted  that  the  C- tuning  tech¬ 
nique  is  not  being  presented  as  a  theoretically  correct 
method  to  regain  system  robustness  for  a  CGT/PI/KF  con¬ 
troller.  Quite  the  contrary,  this  method  is  presented 
simply  as  an  ad-hoc  method  which  happens  to  have  provided 
excellent  results.  To  make  any  statements  about  this 
method  for  general  application  would  require  a  complete 
mathematical  proof  validating  that  the  return  difference 
factions  (at  some  specified  loop  breaking  point  of 
physical  significance)  for  the  controller  both  with  and 
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without  the  Kalman  filter  in  the  loop  asymptotically  become 
equal  as  q  is  increased  in  Equation  (5-47).  However,  time 
did  not  allow  a  full  investigation  of  the  validity  of  this 
approach.  Appendix  G  provides  a  preliminary  explanation 
for  the  results  obtained  using  C-tuning  and  some  comments 
on  the  application  of  LTR  tuning  for  loop  breaking  at  points 
other  than  the  point  at  which  the  input  enters  the  system. 

5 . 8  Summary 

This  section  has  presented  the  pitch  pointing  con¬ 
troller  designed  as  a  part  of  this  thesis  effort.  The 
thought  process  used  to  arrive  at  the  models  and  weighting 
matrices  was  introduced  along  with  their  final  form.  The 
robustness  of  the  final  controller  was  analyzed  in  the  face 
of  parameter  variations,  control  surface  saturations, 
canard  failure,  and  highly  noise-corrupted  measurements. 
Also,  LTR  tuning  was  investigated  as  a  means  to  recover 
the  robustness  of  the  system  lost  by  introducing  a  Kalman 
filter  into  the  controller  to  provide  state  estimates. 
Finally,  an  ad-hoc  method  for  tuning  the  filter  was  intro¬ 
duced  along  with  the  encouraging  results  obtained  using 
this  method. 
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VI.  Conclusions  and  Recommendations 

6 . 1  Introduction 

This  section  is  intended  to  tie  together  the  ideas 
and  design  approaches  presented  in  the  course  of  this 
thesis,  at  a  more  general  and  qualitative  level  than  pre¬ 
viously  used.  This  is  not  a  collection  of  unrelated  ideas, 
but  rather,  an  "overall  view"  of  the  research  conducted 
in  the  course  of  preparing  this  document.  Hopefully,  the 
reader  will  be  able  to  obtain  an  understanding  of  the 
nature  of  the  design  methodologies  which  have  culminated 
in  the  controllers  presented  herein  and  the  implications 
of  these  approaches  for  future  flight  control  designs. 

6 . 2  Conclusions 

The  most  important  result  which  has  been  demon¬ 
strated  in  research  conducted  in  the  writing  of  this  thesis 
is  the  complete  viability  of  the  CGT/PI/KF  design  method 
for  MIMO  advanced  fighter  aircraft  controller  design.  Not 
only  was  this  approach  shown  to  provide  a  systematic  and 
intuitive  design  approach,  but  it  was  also  shown  to  result 
in  a  controller  which  easily  embedded  pilot  handling  quali¬ 
ties  and  overall  system  robustness  directly  into  the 
design  process.  Implicit  model  following  was  used  as  a 
method  to  limit  the  system  bandwidth  to  guard  against 


exciting  ignored  higher-order  dynamics  and  inducing  insta¬ 
bility.  This  allowed  us  to  design  a  system  based  on  a  rela¬ 
tively  low-order  model  (four  states)  which  displayed  excel¬ 
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lent  robustness  characteristics  in  the  face  of  unmodeled 
actuator  dynamics,  control  surface  rate  and  position 
limits,  actuator  failures,  and  extreme  variations  in  both 
the  F  and  B  matrices  of  the  system.  Explicit  modeling  was 
shown  to  be  an  effective  means  to  embed  handling  qualities 
into  the  design  process  with  a  small  increase  in  overall 
controller  complexity.  Finally,  the  nature  of  the  iterative 
design  process  associated  with  the  LQG-based  PI  structure 
allowed  for  useful  insights  to  be  developed  readily  within 
the  design  iterations  themselves  in  order  to  achieve  final 
specifications. 

Another  result  which  is  worth  including  in  this 
discussion  is  the  questions  which  were  raised  pertaining  to 
the  LTR  tuning  of  a  CGT/PI/KF  controller  structure.  While 
not  rigorously  proven  by  any  means,  the  analysis  of  the 
LTR  approach  seemed  to  indicate  that,  in  this  particular 
case,  the  implementation  of  a  CGT/PI/KF  controller  may  not 
be  consistent  with  the  application  of  the  original  Doyle 
and  Stein  method  of  recovering  loop  transmission  charac¬ 
teristics  with  the  loop  broken  at  the  input  to  the  system. 

A  complete  analysis  of  the  frequency  domain  characteristics 
for  the  loop  broken  at  various  points  in  the  system  is 
appropriate  to  establish  the  applicability  of  the  LTR  method. 


At  the  onset  of  this  thesis  effort,  many  goals  were 
set  to  be  accomplished.  Of  these  initial  goals,  most  were 


met  or  addressed  at  least  to  a  limited  degree.  However, 
even  in  light  of  the  work  accomplished,  the  tremendous 
capability  of  the  CG T/PI/KF  design  method  was  not  fully 
exploited  in  the  course  of  this  research  and  bears  further 
investigation. 

6 . 3  Recommendations  for  Further  Study 

Although  some  valuable  ground  has  been  gained  in 
the  course  of  this  thesis  work,  much  more  remains  to  be 
accomplished  in  the  design  and  analysis  of  a  CGT/PI/KF 
flight  controller  for  the  STOL  F-15.  The  major  areas  which 
need  to  be  addressed  are  presented  in  this  section.  This 
is  not  an  "all  inclusive"  list  of  the  possible  ramifications 
of  this  thesis.  However,  it  is  a  list  of  "possibilities" 
which  warrant  being  addressed  in  the  future. 

1.  One  of  the  major  drawbacks  to  the  controller 
designs  which  were  able  to  be  accomplished  in  this  research 
was  the  lack  of  integrated  software.  In  order  to  i  >e  the 
CGT/PI/KF  design  method  to  its  fullest  extent,  interactive 
software  must  be  designed  which  allows  the  designer  the 
flexibility  not  only  to  achieve  the  basic  design,  but  also 
to  test  the  design  using  actuator  and  sensor  noise,  time 
lags,  Kalman  filters  in  the  loop,  servo  saturations  and 
other  designer-specified  nonlinearities,  and  LTR  tuning 


simply  by  specifying  a  scalar  q  value  and  where  the  con¬ 
troller  loop  is  to  be  broken.  Also,  as  will  be  discussed 
below,  the  ability  to  accomplish  structured  singular  value 
analysis  and  frequency  domain  analysis  is  a  "must"  for  the 
proposed  software  as  a  means  to  establish  the  relative 
robustness  of  controllers  in  a  direct  manner.  This  type 
of  integrated  software  package,  were  it  available,  would 
allow  the  designer  the  flexibility  to  design  a  system 
iteratively  while  testing  it  against  increasingly  accurate 
portrayals  of  the  "real  World"  environment  in  which  it  is 
to  function.  Therefore,  it  is  proposed  that  this  type  of 
CAD  package  either  be  designed  or  purchased  for  further 
studies  in  this  area. 

2 .  A  problem  which  arose  in  the  course  of  this 
thesis  was  the  simultaneous  control  of  both  velocity  and 
thrust  vectoring  nozzles.  As  shown  in  Appendix  E,  this 
results  in  a  harshly  nonlinear  system  which  could  not  be 
adequately  controlled  using  the  linear  constant-gain 
approaches  adopted  in  this  thesis  and  parallel  efforts 
(1:20).  Either  a  practical  linearization  should  be  applied 
to  this  system  so  that  linear  techniques  may  be  implemented, 
or,  possibly,  more  advanced  techniques  could  be  applied  to 
this  problem  using  parameter  estimation  or  extended  Kalman 
filtering  techniques. 

3.  For  further  studies  in  the  control  of  the  STOL 
F-15,  the  controller  designs  should  be  tested  in  the  face 


of  wind  gusts  modeled  as  outputs  of  a  linear  time  invariant 
system  driven  by  white  Gaussian  noise.  Additional  states 
to  represent  turbulence  should  be  incorporated  into  the 
truth  model  and  also,  perhaps,  in  the  filter/controller  in 
an  attempt  to  test  controller  robustness  in  turbulence. 

4.  A  logical  progression  from  the  work  accomplished 
in  this  thesis  would  be  to  extend  the  control  designs  to 
multiple  longitudinal  maneuvers  and  to  investigate  lateral 
mode  controllers  as  well.  A  "single  controller"  approach 
could  be  analyzed  in  an  attempt  to  eliminate  the  need  to 
adjust  controllers  to  a  specific  maneuver  while  at  a  fixed 
flight  condition.  This  could  produce  a  control  system  which 
is  able  to  perform  several  maneuvers  and  relieves  the 
pilot  from  "switching  modes"  in  order  to  achieve  different 
maneuvers. 

5.  An  extremely  useful  tool  to  analyze  the  final 
controllers  based  on  the  above  suggestions  would  be  to 
derive  dynamical  equations  of  motion  for  the  STOL  F-15 
which  included  asymmetrical  surface  failures.  This  would 
allow  the  impact  of  mode  coupling  on  the  system  robustness 
to  be  evaluated  in  a  maneuver  such  as  a  coordinated  turn. 

6.  An  interesting  application  of  the  CGT/PI/KF 
controller  could  be  to  attempt  a  more  complicated 
"maneuver."  For  instance,  instead  of  a  coordinated  turn 

or  a  pitch  pointing,  an  entire  evasive  maneuver  or  automatic 


mid-air  collision  avoidance  scenario  could  be  implemented 
using  the  aircraft's  radar  as  a  system  measurement. 

7.  Last,  but  certainly  not  least,  it  is  strongly 
suggested  that  for  any  further  application  of  a  CGT/PI/KF 
controller  synthesis,  the  applicability  of  LTR  tuning  be 
rigorously  verified  and  coupled  with  the  use  of  structured 
singular  value  analysis  and  frequency  domain  analysis  in 
order  to  gain  more  insight  into  the  entire  robustness 


issue. 


Appendix  A:  STOLCAT  Program  Listing 

Introduction 

The  following  computer  code  listing  is  the  STOLCAT 
program  used  to  convert  the  aerodynamic  data  provided  by 
McDonnell  Air  Co.  into  lateral  and  longitudinal  state  space 
three-degree-of -freedom  equations  of  motion  (see  Section 
3.2) .  It  is  written  in  FORTRAN  V  and  is  hosted  on  a  Con¬ 
trol  Data  Corporation  Cyber  mainframe  computer.  This  pro¬ 
gram  is  completely  interactive  and  provides  prompts  to 
specify  the  required  input  and  the  units  for  that  input. 

It  should  be  noted  that  no  means  is  provided  to  store 
entered  data  in  a  permanent  file  structure.  Therefore, 
care  should  be  exercised  to  avoid  making  errors  when  enter¬ 
ing  data  to  avoid  having  to  re-enter  the  program  to  enter 
all  data  from  the  beginning. 


A. 2  STOLCAT  PROGRAM  LISTING 


program  stolcat 

real  alpha,n,s  ,c  ,  b  ,  u  ,dtheta,u,b  ixx  ,biyy,bizz  , 
lb  ixz  ,dalpha,dpr  ,u  t  , 

2cza,czq,czu,czdl,czd2,czd3,czd4,czd5,czd6,czd7,czd8, 

3cxa,cxq,cxu,cxdl,cxd2,cxd3,cxd4,cxd5,cxd6,cxd7,cxd8, 

4c(na,cmq,cmu  ,cmd  1  ,cmd£,cmd3,cmd4,cmd5,cmd6,cmd7,cmd3/ 
5zl,za,zh,zq,zu,zdl,zd2,zd3,zd4,zd5,zd6,zd7,zd3, 

6xa  ,xh  ,xq,xu  ,xd  1  ,xd2,xd3,xd4,xd5,xd6,xd7,xd8, 

7ml ,ma ,mh ,mq ,mu ,md  1 ,md2 ,md3 ,md4 ,md5 ,md6 ,md7 ,md3 
real  cnb,cyb,clb,l,n 
dimension  amat< 4 ,4 > ,bmat< 4 ,8 > 
dimension  d  irmat<  5 ,5 )  ,d  ir  bmaK  5,9) 
character*3  Key,  Key]  ,  datal,  data2,  data3,  run 
characier*l  stabl,stab2 

data  q  /48.1/,s  /608./,  c  /15.94/,  b  /42.7/,  u  /201./ 

data  dtheta  /I 1.8030/,  dalpha  /11.8030/,w  /33576. 14/ 

data  b ixx  /23644 . /,b iyy  /18 1847 . /,b izz  /199874 . /,b ixz  /-3086./ 

data  cza  /-7 . 84976e -2/,  cxa  /I . 5095276e -3/,  cma  /9 . 574 1 18e -3/ 

data  czq  /0./,  cxq  /0./,  cmq  /-. 16951803/ 

data  czu  /- 1 . 0655 1597/,  cxu  /-6 . 1932e -3/,  emu  /6 . 394289e -2/ 
data  ezh  /- 1 . 676463e -4/ ,  exh  /6 . 6B2777e -4/,  crrti  /1.76622e-4/ 
data  czd 1  /-2 . 63634e -3/,  cxd 1  /- 1 . 552420e -3/,  cmd 1  /5.57696e-3/ 

data  czd2  /-8 .3151 le -3/,  cxd2  /-2 . 74967 le -4/,  cmd2  /- 1 . 02066e -2/ 

data  czd3  /-5 . 59 102e -3/ ,  cxd3  / 1 . 157373e -3/ ,  cmd3  /8.52107e-4/ 
data  czd4  /-4 . 50S43e -3/,  cxd4  /9 . 42 1 1093e -4/,  cmd4  /-2 . 1 1 1 18e -3/ 

data  czd5  /I . 896349e -3/,  cxd5  /-3 . 1209S9e -3/ ,  cmd5  /2.55459e-3/ 

data  czd6  /-7 . 422954e -4/,  cxd6  /-3 . 595656e -3/,  cmd6  /-1.30123e-3 

data  czd7  / 1 . 896349e -3/ ,  cxd7  /-3 . 120989e -3/,  cmd7  /2.55459e-3/ 
data  czdS  /-7 . 422954s -4/ ,  cxd3  /-3 . 595653e -3/ ,  cmd3  /-1.30123e-3 


data  clb  /-2. 973933e -3/,  cnb  /-5 . 50S5055e -4/,  cyb  /- 1 . 63794 le -2/ 
data  clp  /-5 . 740524e -3/ ,  enp  /-2 . 33997 19e -3/,  cyp  /  0.000000000/ 


data  clr  /  3 . 902348e -3/,  enr  /-9 . 6993 1 5 le -3/ ,  cyr  /  0.000000000/ 
data  c Id  1/1 .0017e -4/,  end  1/- 1 . 3256e -3/,  cy d 1/3 . 0606e -3/ 
data  c 1 d2/- 1 . 14999e -4/ ,  cnd2/5 . I323e -4/,  cy d2/l . 3 139e -3/ 
data  c 1 d3/8 . 5 104e -4/ ,  cnd3/4 . 4S37e -4/,  cy d3/- 1 . 0622e -3/ 
data  c 1 d4/7 . 5284e -4/ ,  cnd4/7 . 6 133e -5/,  cy d4/- 1 . 5235e -4/ 
data  c  1  d5/6 . 9959e -4/,  cnd5/0.00/,  cyd5/'0.00/ 
data  c 1 dS/9 . 63 16e -5/ ,  cnd6/l . 5934e -4/,  cyd6/0.0/ 
data  c 1 d7/-2 . 7897e -5/,  cnd7/l . 3357e -4/,  cyd7/0.0/ 
data  c 1 dS/-9 . 63 1 6e -5/ ,  cnd3/- 1 . 5334e -4/,  cyd8/0.0/ 
data  c 1 d9/3 . 7897e -5/,  c n d 9/- I . 8357e -4/ ,  cyd9/0.0/ 
dp  r  =  57.2957735 
ur  ite<  *,5) 


5  -formate  lx,  1  *****************  ***********************************>  > 
ur ite<  * ,  10 ) 

10  formate  lx ,' ***  stability  der  iwat  iwe  transformation  program  ***') 
uritee  * ,20 ) 

20  formate  lx, '************** **************************************' > 
uritee  *,100) 

100  formate  lx , ‘enter  body  axis  (non-dimensional ized)  coefficients  ') 
ur  itee  *  ,  10  1  ) 

101  formate  lx , 'for  t r  ans  f or mat  ion  to  d imens ional ized  body  axis') 
ur itee  * , 102 ) 

102  formate  lx ,' and  to  generate  state  and  input  matrices.’) 
ur itee  *,41) 

41  for mate  lx ,' note s  all  coefficients  are  requested  when  computing') 

103  co nt inue 

ur itee  * ,30 ) 

30  formate  lx, '****************************************************' ) 


uritee  *  ,  106 ) 

106  formate  lx , 'to  transform  only  longitudinal  data  -  type  long') 
uritee  *  ,  107  ) 

107  formate  lx , 'to  transform  only  1 ateral -d irect ional  data  -  type 
1  at  '  ) 

uritee  *  ,  108 ) 

103  formate  lx ,' to  transform  both  long  and  lat-dir  data  -  type  both') 
ur  itee  *,111) 


formate 

lx , 'Keyuord 

= 

i 

) 

r  e  3  d  e  *  , 

109) 

Key 

formate  a 3 ) 

i  f  e  Key 

•  eq  . 

'  1  at  '  ) 

go 

t  o 

104 

i  f  e  Key 

.  eq . 

'  Ion  '  ) 

90 

to 

104 

i  f  e  k  e  y 

•  eq . 

'  bot  '  ) 

go 

to 

104 

if e  Key 

.  eq . 

' gam ' ) 

go 

to 

536 

go  to  103 
104  cont  inue 

uritee  * ,300  ) 

300  formate  lx , ' ****************************************************  1  ) 


uritee  *,3  10) 

310  formate  lx,'q  e dynamic  pressure  -  lbs /ft* *2) 
reade  * , * )  q 
uritee  * ,320  ) 

330  formate  lx, 's  (wins  reference  area  -  ft**£) 
read(  *  ,  *  )  s 
uritee  * ,330  ) 

330  formate  lx,  'c  (wing  mean  aerodynamic  cord  - 
reade  *  ,  *  )  c 


) 


'  ) 


ft  ) 


ur i te( * ,340  ) 

540  f  ormate  lx  ,  1  b  (wing  span  —  -f -t  >  =  ’) 
r ead< * , * )  b 
ur ite( * ,550 ) 

550  formate  lx, 'vt  (trim  velocity  -  ft /sec)  =  ') 
read  (  *  ,  *  )  u 
vt=u 

ur ite<  * ,560 ) 

560  formate  lx, 'theta  (pitch  angle  -  degs  )  =  ') 
read( »,*)  dtheta 
ur ite( * ,570  ) 

570  format<lx,'u  (weight  -  lbs)  =  ') 

read( * , * )  u 
ur ite( * ,575 ) 

575  format(  lx  ,  1  inert ias  must  be  input  in  body  axis.') 
uriteC  *  ,580 ) 

580  format(  lx  ,  '  ixx  (slug-ft**2)  =  ') 
read(  * , * )  b  ixx 
ur ite(  * ,585 ) 

585  format(lx,'iyy  (slug -ft*  *2)  =  ') 
r ead(  * , * )  b  iy y 
ur ite(  * ,590 ) 

580  f ormat(  lx  ,  '  izz  (slug-ft**2>  =  ') 
read(*,*)  b  izz 
ur  ite(  * ,595 ) 

595  f ormat(  lx  ,  '  ixz  (slug-ft**2>  *  ') 
r ead( * , *  )  b  ixz 

596  cont  inue 
uriteC  *  ,597  ) 

597  format(  lx,  '****************************************************'  ) 
ur  ite(  *,6  10) 

610  for mat  (  16x,  'aircraft  parameters') 
ur ite( * ,6 15  )  q 

615  format (  1 x , ' q  (  dynamic  pressure  -  lbs /ft* *2)  =  ',gl3.6) 

ur i t  e( *  ,620  )  s 

620  format(  lx,  's  (uing  reference  area  -  ft**2)  =  ',gl3.6) 
ur  ite(  *  ,625 )  c 

623  formate  lx  ,  'c  (uing  mean  aerodynamic  cord  -  ft)  =  1 ,g 13.6) 

ur  itee  *,630)  b 

630  formate  lx,'b  euing  span  -  ft)  =  '  ,g 13.6) 
ur  ite(  * ,635 )  u 

633  formate  lx  ,  '  v t  ( tr im  velocity  -  ft /sec)  =  ' , g 1 3 . 6 ) 

uritee*,640)  dtheta 

640  formate  lx  , 'theta  =  ’,gl3.6) 

ur  ite(  t  ,643  )  u 

645  format (lx,'u  eweight  -  lbs)  =  '  , g  1 3 . 6  ) 
urite(*,630)  bixx 

650  formate  lx, 'ixx  (slug -ft* *2)  =  '  ,  g  1 3 . 6  ) 

ur  ite(  *,635)  b  iyy 


formate  lx  iyy  < s 1  us  — f  t **£  )  =  ',913.6) 
urite<*,660>  b  izz 

formate  lx  izz  eslug-ft**£)  =  ',gl3.6> 
wr itee  * ,665 >  b  ixz 

formate  lx  ixz  eslug-ft**£)  =  ’,gl3.6) 
ur ltee  * ,670 ) 

formate  lx, 'a*************************************************** 1 ) 

coirt  inue 
ur itee  * ,675 ) 

formate  lx , 1  is  the  entered  data  correct  ?  (yes/no)  ') 
reade*,680)  data3 
formate  a3 ) 
ur  itee  * ,685 ) 

formate  lx, 'a***************************************************' > 

ifedata3  .eq.  'no  ')  go  to  104 
ifedata3  ,eq.  ’yes’)  go  to  686 
go  to  600 
cont inue 
ur itee  *  , 105 ) 

formate  lx ,' al pha  edeg)  =  ') 

reade  *  ,* )  dal pha 

theta  *  dtheta  Jpr 

alpha  =  dalpha/dpr 

ifeKey  .eq.  ' lat  '  )go  to  446 

ifeKey  .eq.  'gam')go  to  97 

ur  itee  *,110) 

format  <  lx , 'cza  *  ' ) 

reade*,*)  cza 

ur  ite<  *  ,  1£0  ) 

format  <lx,'cxa  =  ') 

reade*,*)  exa 

ur itee  * , 130  ) 

formate  lx  ,  'cma  =  '  ) 

reade  *,*)  cma 

ur  itee  * , 140 ) 

formate  lx , 'czq  =  ' ) 

reade  *  ,  *  )  czq 

ur itee  * , 150 ) 

formate  lx ,' exq  =  ') 

reade  *  ,  *  )  exq 

ur  itee  * , 160 ) 

formate  lx  ,  'cmq  =  '  ) 

reade  *  ,  *  )  cmq 

ur  itee  * , 170 ) 

formate  lx  ,  ' czu  =  '  ) 

reade*,*)  czu 

ur  itee  * , 130  ) 

formate  lx  ,  'exu  =  '  ) 


reade *  ,  *  >  cxu 
ur  itee *,190) 
formate  lx  ,  'emu 
reade*,*)  emu 
ur itee *,191) 
formate  lx  ,  ' ezh 
reade  *  ,  *  )  ezh 
ur itee  * , 192 ) 
formate  lx  ,  ’ exh 
reade  * , * )  exh 
ur  itee  * , 193 ) 
formate  lx , 'cmh 
reade  * ,  *  )  cmh 
ur  itee  *  ,200  ) 
formate  lx  ,  'czd 1 
reade*,*)  czdl 
ur itee  *  ,202 ) 
formate  lx  ,  'cxd  1 
reade  *  ,  *  )  cxd  1 
ur  itee  * ,204 ) 
formate  lx  ,  'cmd  1 
reade*,*)  cmdl 
ur itee  * ,206 ) 
formate  lx  ,  '  czd2 
reade  *  ,  *  )  czd2 
ur itee  * ,208  ) 
formate  lx  ,  ' cxd2 
reade  * , * )  cxd2 
ur  itee  *,210) 
formate  lx  ,  '  cmd 2 

reade  *  ,  *  )  cmd  2 

ur  ite<  *,212) 
formate  lx  ,  '  czd3 
read(*,*)  czd3 
ur  itee  *,214) 
formate  lx  ,  'cxd3 
reade*,*)  cxd3 
ur  itee  *  ,216  ) 
formate  lx  ,  ’ cmd3 
reade  * ,  * )  cmd3 
ur  itee  *,2  13) 
formate  lx  ,  'czd4 
reade  *,*)  czd4 
ur  itee  * ,45  ) 
formate  lx  ,  1 cxd4 
reade  *,*)  cxd4 
ur  it  ee  * ,50  ) 
formate  lx , ' tmd4 
reade*,*)  cmd 4 
ur  itee  * ,55  ) 


55 


formate  lx  ,' czd5  =  ') 
reade * ,  * )  czdS 
ur itee  * ,60 ) 

60  formate  lx , 'cxd5  =  '  ) 
r ead< * ,  * )  cxdS 
ur itee *  ,65 ) 

65  formate  lx  ,  'cmd5  =  '  ) 
read( *,*)  cmd5 
uritet  *  ,70  ) 

70  formate  lx , ' czd6  =  '  ) 
read( *,*)  czd6 
ur itee  *  ,75  ) 

75  formate  lx , 'cxdS  =  ') 
reade * ,  * )  cxd6 
ur  itee  *,30) 

80  f  ormate  lx  ,  ' cmd6  =  '  ) 

reade  *,*)  cmdG 
uritee  *  ,85  ) 

85  formate  lx  ,  'czd7'  ) 
read<  * ,  * )  czd7 
ur itee  * ,83 ) 

88  formate  lx,'cxd7') 
reade  * , * )  cxd7 
ur itee  *  ,90 ) 

90  formate  lx  ,  'cmd7  =  ') 
reade*,*)  cmd7 
ur itee  *,92) 

92  formate  lx , 'czd8  =  *  ) 
reade  *  ,  * )  czd8 
uritee  *,94) 

94  f or mate  lx ,  ' cxd3  =  1  ) 

reade  *,*)  cxd8 
ur  itee  * ,96 ) 

96  formate  lx ,' cmdS  =  ') 

reade*,*)  cmdS 

97  continue 

ur  itee  *,225) 

225  formate  lx, '*************************** ********************r****‘ ) 

uritee *,230)  dalpha 

230  for mate  15x ,’ al pha  =',gl3.6) 
ur  itee  * ,345 ) 

345  formate  6x,' longitudinal  non-dim  body  axis  coefficientsf  1/deg)') 

cal  =  cose  al pha ) 
sal  =  s  in( alpha) 
cossq  =  cal **2 
sinsq  =  sal* *2 
cossin  =  cal*sal 
cth  =  cose  theta) 


sth  =  s  in<  -theta  ) 


uritee *,360)  cza,cma,cxa 


formate 3x , '  czq 


* ,g 13 . 6 ,8x  , 

'  cma  = 

'  ,g 13 . 6 ,5x  , 

*  exa  = 

' ,g 13.6) 

c  mq , c  x  q 

, g  13 . 6  ,8x  , 

'cmq  = 

1  ,g  13 . 6  ,5x  , 

*  C  X  q  = 

* ,g 13.6) 

c  mh  ,  c  x  h 

1  ,  g  1 3 ■ 6 , 8x  , 

'  c  rnh  = 

'  , g 13 . 6 ,5x  , 

’  exh  = 

10 

(a) 

0) 

emu  , exu 

1  ,  g  1 3 . 6 , 8x  , 

'emu  = 

'  ,g  13 . 6  ,5x  , 

'  exu  = 

' ,g 13.6) 

uritee*, 370)  czd 1 ,cmd 1 ,cxd 1 
formate 2x , 'czd 1  =  '  ,g  13  .  S  ,7x  ,  1  cmd  1  = 
uritee *,380)  czd2 ,cmd2 ,cxd2 
formate  2x  ,  'czd2  =  '  ,g  13 . 6 ,7x  ,  '  cmd2  = 
uritee*, 381)  czd3  ,cmd3  ,cxd3 
formate 2x , 'czd3  =  ' , g 1 3 . 6 , 7x , ' c md 3  = 

urite<*,332)  czd4,cmd4,cxd4 
forma  .(  2x  ,  'czd4  =  '  ,g  1 3 . 6 , 7x  ,  '  cmd4  = 

uritee*,383)  czd! ,cmd5 ,cxd5 
formate  2x  ,  'czd5  =  ‘  ,g  1 3 . 6 , 7x  ,  '  cmd5  = 
uritee *,334)  czdS ,cmdS ,cxd6 
-f  ormate  2x  ,  '  czd6  =  1  ,g  13 . 6 ,7x  ,  ’  cmd6  = 
uritee *,385)  czd7,cmd7,cxd7 
formate  2x , *czd7  =  ‘,gl3.6,7> 
ur  itee  a  ,336  )  czd8  ,cmd8  ,cxd8 
formate 2x , ‘ czd8  =  ’ ,g 13 . 6 ,7x , ’ cmd8 

uritee *,310) 

formate  lx, '********************************************»*******• ) 


'  c  md  1 

= 

, g  13 . 6 ,4x  , 

'  cxd  1 

= 

',913.6) 

'  cmd2 

= 

'  ,g  13 . 6 ,4x  , 

•cxd2 

= 

'  ,9  13.6) 

'  cmd3 

= 

' ,g 13 . 6 ,4x  , 

'  cxd3 

= 

' ,9 13.6) 

'  cmd4 

= 

'  ,g  1 3 . 6 ,4x  , 

'  cxd4 

= 

',913.6) 

'  cmd5 

= 

'  ,g  13.6,4x  , 

1  cxd5 

s 

’  ,9  13.6) 

’  cmd6 

= 

' ,g 13 .6 ,4x  , 

1  cxd6 

= 

'  ,9  13.6) 

'  cmd7 

= 

'  , g  1 3 . 6 ,4x  , 

'  cxd7 

= 

(0 

m 

n 

* 

'  cmd8 

= 

'  ,g  13.6,4x  , 

1  cxd8 

3 

'  ,g 13.6) 

cont inue 
uritee  * ,320  ) 

formate  lx ,' is  the  entered  data  correct  ?  eyes /no)') 

reade*,330)  datal 
format e  a3 ) 

ifedatal  .eq.  'no  ')  go  to  686 
if< datal  .eq.  'yes')  go  to  340 
go  to  315 
cont inue 
uritee  * ,420 ) 

formate  lx,'******************************* *********************') 


zl  *  eq*s*32.2)/u 
a  *  c  /e  2 . 0  *u  ) 
theta  =  dtheta/dpr 

za  =  z 1 *c:a*dpr 
zh  =  e  z 1/u ) *czh 
zq  =  z 1 *a*czq*dpr 
z  u  =  2,*(zl/u)*czu 
zdl  =  z Itczd  l*dpr 


134 


W] 


zd2  =  zl*czd2*dpr 
zd3  =  zl*czd3*dpr 
zd4  =  z  l*czd4*dpr 
zd5  =  zl*czd5*dpr 
zd6  =  zl*czd6*dpr 
zd7  =  zl*czd7*dpr 
zdS  =  zl*czd3*dpr 

xa  =  z  1  #cxa*dpr 
x  h  =  (zl/u)*cxh 
xq  =  zl*a*cxq*dpr 
xu  =  2 .  *<  z  1/u  ?  *cxu 
xdl  =  z 1 *cxd  1 *dpr 
xd2  =  z  1  *cxd2*dpr 
xd3  =  zl*cxd3*dpr 
xd4  *  z  Ucxd4*dpr 
xd5  =  zl*cxd5*dpr 
xd6  =  zl*cxd6*dpr 
xd7  =  zl*cxd7*dpr 
xd8  =  zl*cxd8*dpr 

ml  =  (  qts*c  )/b  iyy 

ma  =  ml*cma*dpr 
mh  =  (ml/u)*cmh 
mq  =  ml*a*cmq*dpr 
mu  -  2  .  *<  ml/u  )  *cmu 
md  1  =  rnl*cmdl*dpr 
md2  =  ml*cmd2*dpr 
md3  =  ml  *cmd3*dpr 
md4  =  rn  1  *cmd4*dpr 
md5  =  ml  *crr.d5*dpr 
mdS  =  mltcmd6*dpr 
md7  =  ml  *crr.d7*dpr 
mdS  =  ml*cmd3*dpr 

ur *  , 709 ? 

formal  (5x,  'longitudinal  axis  d  ii.*.ns  ional  derivatives'? 
ur ite<  * ,705  ? 

format  <15x,'body  axis  ( l/rad) ' ) 
urite<*,710?  za,ma,xa 

■formatt  4x  ,  'za  =  1  ,g  1 3 . 6 ,  9x  ,  '  ma  =  '  ,gl3.6,6x,'xa  =  ',913.6? 
ur  ite<  *, 720?  zq,mq,xq 

f ormat< 4x , ’ zq  =  ' , g 1 3 . 6 , 9x , 1 mq  =  '  ,  g  1 3 . 6 , 6x , ' xq  =  ’,913.6? 

urite<*,730>  zh  ,mh  ,xh 

f ormat< 4x , 'zh  =  1 , g 1 3 . 6 , 9x , ' mh  =  * ,g 13 . 6 ,6x , ' xh  =  ',913.6? 
urite<*,740?  zu ,mu ,xu 

formate  4x , 'zu  =  1 , g 1 3 . 6 , 9x ,  ' mu  =  ’  ,g  13 . 6 ,6x , ' xu  =  ',gl3.6? 
ur itee * ,750 ?  zdl,mdl,xdl 

formate  3x , 'zd 1  =  '  ,gl3.6,8x,'mdl  =  ',g!3.6,5x,'xdl  =  ',g!3.6? 


.•  v  v  -.'V. *x 

-  ■*>-  * 


»**•  ,  /*  .  v*v  v 


1 ,9  13 . 6  ,5x  ,  * xd2 


,9  13.6) 


urite<*,760)  zd2,md2,xd2 
760  f or mat (  3x , ' z d 2  =  ' ,gl3.6,8x,' md2  = 
urite<*,770)  Zd3,md3,xd3 


770 

f ormat< 3x , ■ zd3  =  ' ,g 13.6 ,8x , 'md3 
urite<»,780>  zd4,md4,xd4 

= 

' ,g 13.6,5x  , 

‘  xd3 

= 

',913.6) 

780 

f ormat< 3x , ' zd4  =  ' , g 1 3 . 6 ,8x , ' md4 
ur ite(  *  ,790 )  zd5,md5,xd5 

= 

'  ,g  13 . 6 ,5x  , 

1  xd4 

— 

'  ,g  13.6) 

780 

formate 3x , *zd5  =  1  , g 13 . 6 ,8x , ’ md5 
urite<*,800)  Zd6,md6,xd6 

= 

1  ,g 13 . 6 ,5x  , 

'  xd5 

= 

' ,9 13.6) 

800 

formate 3x , 'zd6  =  1 ,g 13 . 6 ,8x , ' md6 
urite<*,810)  Zd7,md7,xd7 

= 

,  9  1 3 . 6 , 5x  , 

'  x  d6 

— 

' ,9 13.6) 

810 

formate  3x , 'zd7  =  ' ,g 13 . 6 ,8x , ' md7 

urite<*,820)  zdS,md8,xd8 

= 

'  , g 1 3 . 6  ,  5x  , 

1  xd7 

= 

' ,g 13.6) 

820 

formate 3x , ‘ zd8  =  1 ,g 13 . 6 ,8x , ' md8 

= 

1  ,g 13.6 ,5x  , 

'  xdS 

= 

',913.6) 

ur  i"te<  *  ,830  ) 

830  formaK  lx, *  ft***************************************************'  ) 


dewelopmeirt  of  state  matricies 
development  of  the  plant  matrix  -  a 


wt  =u 

amate 1,1) 

= 

XU 

amate  1,2) 

= 

-ytasal 

amate  1,3) 

= 

xa 

amat<  1,4) 

= 

-32.2*cth 

amate  2,1) 

= 

mu 

amat<  2,2) 

= 

mq 

amate 2,3) 

= 

ma 

amate  2,4) 

= 

0.0 

a mat  <  3 , 1  ) 

= 

zu/vt 

amate  3  ,2 ) 

= 

cal 

amate  3,3) 

= 

za/wt 

amat(  3,4) 

= 

-32 .  2#sth  A/t 

amatc  4,1) 

= 

0.0 

amate 4,2) 

= 

1 .0 

amate  4,3) 

= 

0.0 

amate  4,4) 

= 

0.0 

ur  ite<  * , *  ) 
ur ite<  * ,850  ) 

850  format<'l',5x,'longitudnal  state  matr ix<  body  axis)') 
ur  ite<  * , *  ) 
ur  ite<  *  ,842 ) 

842  formate  '0',2x,'for  st ate  1 =u ,st ate2=q ,state3  =  al pha ,state4=theta  '  ) 
u  r  i  t  e  <  *  ,  *  ) 
do  855  1=1.4 


ur  ite!  *  ,860  )  (  amat!  i  ,  j  )  ,  j  =  1  ,4  ) 
cont inue 

formats  '0'  ,  2x ,4!  g 1 3 . 6  ,4x ) ) 
ur ite!  * , * ) 

nou  ue'll  get  the  input  matrix  -  b 


bmat!  1,1) 

= 

xd  1 

bmat!  1,2) 

= 

xd2 

bmat!  1 ,3) 

= 

xd3 

bmat!  1,4) 

= 

xd4 

bmat!  1,5) 

= 

xd5 

bmat!  1,6) 

= 

xd6 

bmat!  1,7) 

= 

xd7 

bmat!  1,8) 

= 

xd8 

bmat!  2,1) 

= 

md  1 

bmat!  2,2) 

= 

md2 

bmat!  2,3) 

= 

md  3 

bmat!  2,4) 

= 

md4 

bmat!  2,5) 

= 

md5 

bmat!  2,6) 

= 

md6 

bmat!  2,7) 

= 

md7 

bmat!  2,8) 

md  8 

bmat!  3,1) 

= 

zd 1/vt 

bmat! 3,2) 

= 

2d2/vt 

bmat!  3,3) 

= 

2d3/vt 

bmat!  3,4) 

S 

2  d  4  /v  t 

bmat!  3,5) 

= 

2d5/vt 

bmat!  3,6) 

= 

2d6/vt 

bmat!  3,7) 

= 

2d7/vt 

bmat!  3,8) 

= 

2d8/vt 

do  365  i = 1 

! 

b mat !  4  ,  i  ) 

= 

0.0 

cont inue 

print  out  the  long  input  matrix 

ur ite!  *  ,  *  ) 
ur ite<  * ,870  ) 

format!  '0'  ,3x, 'longitudnal  input  matrix') 
ur ite!  *  ,  *  ) 
ur ite!  * ,868  ) 

format!  ,  'for  de  1  1  =c  an  ar  d  ,  d  e  1  2  =& t  ab  ,de  1  3  =  t  e  f  ,de  1  4  =dr  aileron') 
write!  * ,868 ) 

format! 2x  ,  '  del5=rt  rv,  del6=rb  rv  ,  del7  =  lt  rv  ,  del8  =  lb  rv  '  ) 
write!  *  ,  *  ) 
write! *,*) 
write!  * ,37 1 ) 

format!  '0'  ,5x,'roul  '  ,llx,  'rou2  1  ,llx,  'row3'  ,llx,  'rou4  '  ) 
write!  *  ,  *  ) 


do  872  1=1,8 
wr  1  te<  *  ,880  )  <  bmat(  j  ,  i  )  ,  j  =1  ,4) 

372  con*  inue 

wr  ite<  * ,  *  ) 

B75  coirt  inue 

wr  ile(  *  ,873 ) 

B73  f  or  mat  <  lx,'  do  you  want  stab  axis  data  -for  long?(  y/n )  ‘  ) 
read<*,874>  stab  1 
B74  formate  a  1 ) 

if  <  stabl  .eq.  'y‘  )  go  to  877 
if  <  stabl  .eq.  'n'  )  go  to  857 
go  to  875 
B77  cont  inue 

*****  *********** *********************  ********************** 

*<  c  <  <  <  c  <  * 

*<  concert  body  axis  data  to  stability  ax  is(  * 

*<  (  for  checK  uith  mcair  dataH  (  * 

*<<<<<<<  * 

*<<<<<<<  * 


smu  =<  mu*cal  +  <  ma/u  )  *sal  *cal  ) 

srrir:  =<  <  smu  /  mu  )  *  mh  ) 

sma  =<  ma  *cossq  -mu  *  u  *  sal  ) 

s  mq  =  mq 

srr.d  1  =  md  1 


s  md  2  =  md  2 
s  md  3  =  md  3 
s  md  4  =  md  4 
s  md  5  =  md  5 
s  md  S  =  md  6 
s  md  7  =  md  7 
s  md  3  =  md  8 


S  X  u  =x  u 
sx  h  = 
s  x  a  = 

S  X  q 

sxd  1  = 
sxd2  = 
sxd3  = 
sxd4  = 
sxd5  = 


*cossq+<  za/u  )  *s  insqtcal  +<  (  xa/'u  )  *cal  +zu  )  *sal  teal 
<  sxu/xu ) *xh 

xa*cal**3  -u*zu*sinsq  -  (u*xu  -  z  a  *c  a  1  >  *c  a  1  *s  a  1 


z  a  *c  a  1  )  *c  a  1  *s  a  1 


xq*cal  ♦ 

<  xdltcal 
xdStcal 

<  xd3*cal 
e  xd4*cal 
< xd5*c  al 

<  x d6 *c a  1 

<  >:  d  7  *  c  a  1 
e  xd3*cal 


zq*sal  ) 

+  z  d  1  ti a  1  ) 
+  z  d 2  *s  a  1  ) 
+  z  d  3  *s  a  1  ) 
♦  zd4*sal  ) 
+  z  d  5  *  s  a  1  ) 
+  zd6*sal  ) 
z  d  7  *s  a  1  ) 
+  z  d3  *s  a  1  ) 


szu=zu*cossq-'l  xa/'u  )*s  insq*cal  -C  xu-<  za/u  )  tc  a  1  )  *s  a  1  teal 
s  z  h  =  <  s  z  u  /z  u  )  *  z  h 


sz  a=z  a*c  al  **3  +  u*xu*s  insq  -  eu*zu  +  xaical  )  teal  *sal 

szq  =  ( zqaeal  -  xqtsal  ) 

szd 1  =  <zdl*cal  -  xdl*sal) 

szd2  =  <zd2*cal  -  xd2*sal  ) 

szd3  =  <zd3*cal  -  xd3*sal  ) 

szd4  =  <zd4*cal  -  xd4*sal  ) 

szd5  =  <zd5*cal  -  xd5*sal) 

szd6  =  <zd6*cal  -  xd6»aal  ) 

szd?  =  ezd7*cal  -  xd7*sal) 

szdS  =  (zd3*cal  -  xd3*sal) 

ur itee  *  ,70  1  ) 

format  <  '  0  '  ,5x  ,  1 1  ong  itud  inal  axis  dimensional  derivatives') 
ur itee  * ,702 ) 

format  <  15x  ,  ‘  stab il  ity  ax  is  <  1/rad )  1 ) 


ur itee  *,711) 

s  z  a , s  ma , s  x  a 

formate  4x , 'za 

=  '  ,  g  1  3 . 6  ,  9x  , 

'  ma  = 

'  , g 1 3 . 6 , 6x  , 

'  xa  = 

' , g 13.6) 

ur  itee  *  ,72  1  ) 

szq,smq,sxq 

formate  4x , ' zq 

=  ',gl3.6,9x. 

'  rnq  = 

'  ,g  13 . 6 ,6x  , 

•xq  = 

' ,g 13.6) 

ur  itee  * ,73  1  ) 

szh ,smh ,sxh 

formate  4x , ' zh 

=  '  ,g 13 . 6 ,9x  , 

'  mh  = 

'  ,  g  1 3 . 6 ,6x  , 

'  xh  = 

’,913.6) 

ur  itee  *,74  1) 

szu ,smu  ,sxu 

formate  4x , 'zu 

=  ',gl3.6,9x. 

'mu  = 

'  ,  g  1 3 . 6 , 6x  , 

'  xu  = 

' ,g 13.6) 

urite<*,751)  szd  1  ,smd  1  ,sxd  1 

f  ormat<  3x  ,  1  zd  1  *  1  ,g  13 . 6  ,8x  ,  1  md  1  =  '  ,g  13 . 6 ,5x  ,  ’  xd  1  =  ',gl3.6) 

uritee*,761)  szd2 ,smd2 ,sxd2 

formate  3x , 'zd2  =  ' ,g 1 3 . 6 ,8x , ' md2  =  ' ,g 13 . 6  ,5x , ' xd2  =  ',gl3.6> 

ur  ite<  *  ,77 1  )  szd3 ,smd3 ,sxd3 

formate 3x , 'zd3  =  ' , g 1 3 . 6 ,8x , ' md3  =  ' ,g 1 3 . 6 ,5x , ' xd3  *  ',gl3.6> 
uritee*,731)  szd4  ,smd4  ,sxd4 

formate  3x , 'zdd  =  ' ,g 13 . 6 ,8x , ' md4  =  ' ,g 13 . 6  ,5x , ’ xd4  =  '  ,gl3.6) 

uritee*,791)  szd5  ,smd5  ,sxd5 

formate  3x , 'zd5  =  ',gl3.6,8x,,md5  =  ',gl3.6,5x,’xd5  =  ' ,gl3.6) 
uritee*,300)  szd6 ,smd6 ,sxd6 

formate  3x , 'zd6  =  ' ,g 13 . 6 ,Sx , 1 md6  =  1  ,g 13 . 6  ,5x , ' xd6  =  ’,gl3.6) 
ur  itee  *,31  1  )  szd7,smd7,sxd? 

f ormate 3x , 'zd7  =  ' ,g 13 .6 ,8x , 'md7  =  ' ,g 13 . 6 ,5x , ' xd7  =  ’,gl3.6) 

uritee*,S20)  szd8 ,smd8 ,sxd8 

for mate 3x ,' zd8  =  '  ,  g  1  3 . 6 , 8x  ,  1 md 8  =  1  ,g 13 . S ,5x ,  ' xd8  =  ',913.6) 

ur  itee  *  ,830 ) 

formate  2x ,4e  g 13.8 ,2x ) ) 

amate  1,1)  =  sxu 
amat  e  1 ,2)  =  0.0 
amate  1,3)  =  sxa 
amate  1,4)  =  -32.2*cth 
amate  2,1)  =  s mu 
amate  2,2)  =  smq 

amate  2,3)  =  sma 
amate  2,4)  =  0.0 
amate  3,1)  =  szu/u 


amate  3,2)  =  1.0 
amate 3,3)  =  sza/u 
amate 3,4)  =  -32.2*sth/u 
amat(  4,1)  =  0.0 
amat< 4,2)  =  1.0 
amal(  4,3)  =  0.0 
amatC 4,4)  =  0.0 
ur  ite(  *,851) 

85 1  format(  '0 1 ,5x  ,  'long itudnal  state  mat r ix  (stab  axis)') 
ur  ite<  *  ,  *  ) 
ur ite< * ,842  ) 
ur ite<  *,*) 
do  856  i  =  1  ,4 

urite(*,860)  <  amat  <  i  ,  j  )  ,  j  =  1  , 4  ) 

856  cont  inue 

857  cont  inue 

i-f  (Key  .eq.  'bot*  )  go  to  446 

j  if  (Key  .eq.  'gam'  )  go  to  *465 

42 1  continue 

ur  ite(  * ,430 ) 

430  for mat  (  lx,' is  another  program  run  desired  ?  (yes /no)') 
read!  *  ,440  )  run 

440  f ormat( a3 ) 

ur  ite(  *  ,445 ) 

445  format(  lx , ' ****************************************************  '  ) 

if(run  .eq.  'no  ')  go  to  450 
if ( run  .eq.  'yes')  go  to  103 
go  to  421 

446  cont  inue 

this  is  uhere  the  lateral  directional  starts 
u  r i t  e ( *,1110) 

1110  formate  lx  ,' c 1 b  (1/deg)  =  ') 

read( *,*)  clb 
ur  ite(  * , 1 120  ) 

1 120  formate  lx  ,  '  cnb  (1/deg )  =  ') 

read( *,*)  cnb 
urite( *,1130) 

1 130  formate  lx  ,  'cyb  (  1/deg )  =  ' ) 
r ead( *  ,  *  )  cyb 
ur  ite(  * , 1 140) 

1 140  formate  lx  ,  '  c 1 p  (  1/deg  )  =  '  ) 

read(*,*)  clp 
ur ite( *,1150) 

1 150  formate  lx  ,  'enp  (1/deg)  =  ') 

r ead<  *  ,  *  )  enp 
ur  ite(  *  ,  1 160 ) 

1160  formate  lx,  'cyp  (  1/deg)  =  '  ) 


ur ite< *,1330) 

1330  f ormat(  lx  ,  ' cnd5  <  1/deg)  =  ') 
reade  * , * )  cnd5 
ur  itee  *,1340) 

1340  formate  lx  ,' cyd5  <  1/deg )  =  ') 
read<  * , *)  cyd5 
ur ite< *,1350) 

1350  4 ormate  lx , ' c 1 d6  e  1/deg)  =  ') 
read<  * ,*  >  c 1 dS 
ur  i-te<  *,1360) 

1360  4 ormate  lx  ,  • cnd6  <  1/deg)  =  ') 
r ead<  * , * )  cnd6 
ur  itee  *  ,  1370 ) 

1370  -formats  lx, ’cyd6  <l/deg)  =  ') 

reade  * , * )  cy d6 
ur  itee  * , 1330 ) 

1330  -formate  lx  ,  'cld7  ei/deg)  =  ') 
r eade  * , * )  c  1  d7 
ur itee  * , 1390 ) 

1390  formate  lx ,' end?  e  1/deg )  =  ') 
r eade * , * )  end? 
ur itee  *, 1400) 

1400  formate  lx ,' cyd?  (  1/deg)  =  ') 
r eade  * , * )  cy d7 
ur  itee  *, 1410) 

1410  formate  lx  ,  1  c 1 d3  e  1/deg)  =  ') 

r eade  * , * )  c 1 d8 
ur  itee  *  ,  1420 ) 

1420  for mate  lx  ,' cnd3  e  1/deg)  =  ') 
readC  *,*)  cnd8 
ur  itee  *,  1430) 

1430  formate  lx  ,' cy d3  e  1/deg )  =  ’) 
reade  * , * )  cyd8 
ur  ite<  *  ,  1440 ) 

1440  for ma teix,'cld9  e  1/deg )  =  ') 
re  ad(  * , * )  c 1 d9 
ur itee  *  ,  1450 ) 

1450  formate  lx , 'cndS  e 1/deg )  =  ■ ) 

reade  * , * )  cnd9 
ur  itee  * , 1460 ) 

1460  formate lx,'cyd9  e  1/deg )  =  ') 
reade  * ,  * )  cyd9 

1465  continue 

ur  itee  *,  1470) 

1470  formate,l',8x,'lat-dir  body  axis  coefficients') 
ifeieey  .eq.  'Ion')  go  to  1490 
if<Key  .eq.  'bot')  go  to  1490 
ur itee *, 1430 )  dalpha 

1480  formate  15x alpha  =  ’,gl3.6) 

1480  cont  ir.ue 


ur  itee *  ,  1500 )  clb,cnb,cyb 

1500  f  ormate  3x  ,  ■  c  1  b  =  ' ,g 13 . 6 ,8x  ,  '  cnb  =  *  ,g  13 . 6 ,5x  ,  '  cyb  =  ',gl3.6) 
ur itee * , 15 10 )  dp  ,cnp  ,cyp 

1510  formate 3x  , 'clp  =  '  ,g  13 . 6 ,8x  ,  '  enp  =  '  ,g  13 . 6  ,5x  ,  ‘  cyp  =  ’,gl3.6) 
ur  itee *, 1520 )  clr,cnr,cyr 

1520  f ormate 3x , 'clr  =  '  ,g  13 .6  ,8x  ,  'enr  =  ' ,g 13 . 6 ,5x  ,  '  cyr  =  ‘,gl3.6> 
ur  ite<  * ,  1530 >  c 1 d  1  ,cnd  1  ,cy d  1 

1530  -formate  2x  ,  '  c  1  d  1  =  '  ,g  13 . 6 ,7x  ,  'end  1  =  ‘  ,g  13 . 6 ,4x  ,  •  cyd  1  =  ',gl3.6> 
ur  itee * ,  1540 )  c 1 d2  ,cnd2 ,cyd2 

1540  -formate  2x  , ‘c  1  d2  =  '  ,g  13 . 6 ,7x  ,  '  cnd2  =  •  ,  g  1 3 . 6 ,4x  ,  ■  cy  d2  =  ',gl3.6) 
ur  itee *, 1550 )  c ld3  ,cnd3 ,cyd3 

1550  tor mate  2x  ,  ' c 1 d3  =  ‘  ,g  13 . 6 ,7x  ,  ' cnd3  =  '  ,g 1 3 . 6 ,4x , ' cy d3  =  *,gl3.6> 
ur  itee *,  1560 )  c 1 d4  ,cnd4  ,cyd4 

1560  -formate  2x,  ’cld4  =  *  ,g  13 . 6 ,7x  ,  *  cnd4  =  '  ,g  13 . 6 ,4x  ,  '  cyd4  =  ',gl3.6) 
ur  itee *,  1570 )  c 1 d5  ,cnd5 ,cy d5 

1570  -formate  2x  , 'cld5  =  '  ,g  13 . 6  ,7x  ,  1  cnd5  =  '  ,g  1 3 . 6  ,4x  ,  ‘  cy  d5  =  ',gl3.6) 
ur  i tee *,  1580 )  c 1 d6  ,cnd6 ,cyd6 

1580  -formate  2x  , ‘cld6  =  '  ,  g  1 3 . 6 , 7x  ,  '  c  nd6  =  '  ,g  13 . 8 ,4x  ,  *  cy  d6  =  ‘,gl3.6) 
ur  itee  *, 1590 )  c 1 d7  ,cnd7 ,cyd7 

1590  -formate  2x, ‘cld7  =  '  ,g  13 . 6 ,7x  ,  '  cnd7  =  '  ,g  13.6  ,4x  ,  ‘cyd7  =  ',gl3.6> 
ur  itee *,  1600 )  c 1 d8  ,cnd8 ,cyd3 

1600  f ormate 2x , 'cld8  =  '  ,g  13 . 6 ,7x , 'cnd8  =  ‘  ,g 13 . 6 ,4x , ‘ cy d8  =  ',gl3.6> 
ur  ite< *,  16 10 )  c 1 d9  ,cnd9 ,cyd9 

1610  -formate  2x  ,  'c  1  d9  =  ‘  ,g  13 . 6 , 7x  ,  ‘  cnd9  =  ’  ,g  13 . 6 ,4x  ,  ‘  cy  d9  -  *,gl3.6> 
ur itee  * , * ) 
ur itee  *,1620) 

1620  -formate  lx,  '****************************************************'  ) 

1625  continue 

ur  itee  *,  1630) 

1630  formate  lx  ,' is  the  entered  data  correct  7  e yes/no )' ) 
r  eade  * , 1640)  data2 

1640  formate  a3) 

if  e  data2  .eq.  'no')  go  to  448 
if  e  data2  .eq.  'yes'  )  go  to  1645 
go  to  1625 

1645  cont inue 

ur itee  * ,  1646 ) 

1646  formate  lx ,' do  you  uant  stab  axis  data  for  lat-dir?  (y/n)  ' ) 
reade*,1647)  stab2 

1647  formate al) 

if  e  stab 2  .eq.  'n')  go  to  1S01 
if  e  stab2  .eq.  'y ' )  go  to  1643 
go  to  1645 

1643  cont inue 

bsal ph  =  -al pha 
csa=cose  bsalph  ) 
ssa  =  s ine  bsalph) 


"m  ".  m  IV it*  nm  nw  ■  w t-wt-cw. 


!Clp=Clp*CS  + 

sc  1 r  =c 1 r  acs  - 
sclb=clbacsa  - 
sc  1 d 1 =c 1 d 1 ac  sa 
sc  1 d2=c 1 d2ac  sa 
sc  1 d3=c 1 d3acsa 
sc  1 d4  =c 1 d4acsa 
sc  1 d5=c 1 d5acsa 
scl d6=c 1 d6*csa 
sc  1 d7=c 1 d7*csa 
scld8=cld8acsa 
sc  1 d9=c 1 d9acsa 


enr  ass  -  <  clr 
cnp  ass  +  <  c 1 p 
cnb  *ssa 

-  end  1  assa 

-  cnd2assa 

-  cnd3*ssa 

-  cnd4assa 

-  cnd5assa 

-  cnd6assa 

-  cnd7assa 

-  cnd8*ssa 

-  endSassa 


+  cnp  )  aesaassa 
-  enr ) aesaassa 


scnp=cnp*cs  - 

scnr=cnr*cs  +  < 

scnb=cnb*csa  + 

send  1 =cnd 1 *csa 

scnd2=cnd2*csa 

scnd3=cnd3*csa 

scnd4=cnd4acsa 

scnd5=cnd5*csa 

scnd6=cnd6*csa 

scnd7=cnd7acsa 

scnd3=cnd3*csa 

scnd9=cnd9*csa 


lr*ss  +  <clp  - 
1  P  as  s  ♦  <clr  + 
c 1 b  assa 
+  cldl*ssa 
+  c 1 d2assa 
+  cld3assa 
+  c 1 d4*ssa 
+  cl  d5assa 
+  cld6assa 
♦  cld7*ssa 
+  cld3assa 
+  cld9tssa 


enr)  aesaassa 
cnp ) aesaassa 


scyp=cyp*csa  -  cyrassa 
scyr=cyr*csa  +  cypassa 
scyb-cyb 
ur  itee  *,  1471  ) 


1471  f  ormate  8x  ,  '  1  at  -d  ir  stab  axis  coe-f  f  ic  ients  1  ) 
ur  itee  a , 150 1 )  sclb,scnb,scyb 


150  1 

formate  3x ,  'clb  =  ' 

,9 13.6,8x , 

'cnb  = 

' ,9 13 . 6 ,5x  , 

'  cy  b  = 

' ,g 13.6) 

ur  itee  a  ,  15  1  1  )  selp 

,scnp  ,scyp 

1511 

formate  3x , 'clp  =  ' 

,9  1  3 . 6 , 8x  , 

'cnp  = 

'  ,g 13 . 6  ,5x  , 

'  c  y  p  = 

' ,9 13.6) 

ur  it ee  a  ,  152  1  )  sc  1 r 

,scnr  ,scyr 

1521 

formate  3x , 'clr  =  ' 

,9  13 . 6 ,8x  , 

'enr  = 

'  ,9  1 3 . 6 ,5x  , 

'  cy  r  = 

' ,g 13.6) 

ur itee * , 153 1 )  scldl,scndl,cydl 


1531 

formate  2-x  ,  'eld  1  =  ' , g 13 . 6 ,7x  ,  '  end  1 
ur itee a  ,  154  1  )  sc  1 d2  ,scnd2 ,cy d2 

= 

'  ,9 13.6 , 4x  , 

'  c  y  d  1 

= 

'  ,9  13.6) 

154  1 

f ormate 2x , ' c 1 d2  =  '  ,g 13 . 6 ,7x  ,  '  cnd2 
ur itee a  ,  155  1  )  sc  1 d3  ,scnd3 ,cyd3 

= 

'  ,9 13.6,4x  , 

'  cy  d2 

— 

' ,9 13.6) 

1551 

•formate  2x  , 'cld3  =  '  ,g  13 . 6 ,7x  ,  ’  cnd3 
ur  itee  a  ,  156 1 )  sc  1 d4  ,scnd4  ,cy d4 

= 

'  ,9  1 3 . 6 ,4x  , 

'  cy  d3 

= 

' ,913.6) 

156  1 

formate 2x , *c 1 d4  =  '  ,g  13 . 6 ,7x , ' cnd4 

ur  itee  a,  1571)  scld5, sends, cyd5 

= 

'  ,9  13 . 6 ,4x  , 

'  cy  d4 

= 

' ,9 13.6) 

157  1 

f ormate 2x ,' c 1 d5  =  '  , g  1 3 . 6 , 7x  ,  '  c nd 5 
ur  itee  a,  1581 )  scld6,scnd6,cyd6 

= 

'  ,9  13 . 6 ,4x  , 

'  cy  d5 

— 

' ,9 13.6) 

158  1 

•f  ormate  2x  ,' c  1  dS  =  '  ,9  13 . 6 ,7x  ,  '  cnd6 

= 

'  ,  g  1 3 . 6 , 4  x  , 

'  cy  d6 

= 

' ,9 13.6) 

'  ,9  13.6 ,4x , ' cy d6 


,9  13.6) 


wrize<*,1591)  scld7,scnd7,cyd7 
1591  f or mat< 2x , ' c 1 d7  =  1  ,g  13 . 6 ,7x , ' cnd7 
ur  ite< *  ,  160 1  )  sc  1 dS  , scndS  ,cyd3 
1601  formal  2x  ,  '  c  1  d8  =  '  , g 13 . 6 , 7x , ' cnd3 
urite(*/1611)  scld9,scnd3,cyd3 
1611  f  orma«  2x  ,  'c  1  d9  =  '  , g  1 3 . 6 , 7x  ,  ' cnd9 
ur  ite<  * ,  *  > 


' ,g 13.6,4x  , 'cyd7  =  ‘,gl3.6> 
'  ,g  13.6,4x , 'cyd3  =  ',913.6) 
'  ,g  13.6,4x , ’cyd9  =  ',gl3.6) 


s  ixx =b  ixx icossq  +  bizz*sinsq  -  b ixz *s in< 2*al pha ) 
s iyy  =b  iyy 

s  izz =b izz *cossq  +  bixx*sinsq  ♦  b ixz *s in< 2*al pha  ) 
s ixz =b ixz *cos< 2*al pha )  +  .5*<bixx  -  b iz z > *s in< 2*al ph a ) 

sn  =  dpr*<  <i*s»b  )/s  izz 
si  =  dpr*(q*s  *b)/sixx 
sb  =  b/<2.0*u) 
sy  =  dpr  *<  q*s  #32 .2  )/u 
snb  =  sn*scnb 
snp  =  sn*sb*scnp 
snr  =  sn*sb*scnr 
snd  1  =  sn  *scnd  1 
snd2  =  sn*scnd2 
snd3  =  sn»scnd3 
snd4  =  sn*scnd4 
snd5  =  sn*scnd5 
snd6  =  sn*scnd6 
snd7  *  sn*scnd7 
snd8  =  sn*scnd8 
snd3  =  sn*scnd9 


sib  = 

s 1 *sc  1  b 

sip  = 

si *sb  *3C  1  P 

sir  = 

s 1 *sb  *sc  1  r 

sld  1 

=  si *sc  1  d  1 

sld2 

=  s 1 *sc 1 d2 

sld3 

=  s 1 *sc 1 d  3 

s  1  d4 

=  s  1  *sc  1  d4 

sld5 

=  s 1 *sc l d5 

side 

=  si tsc 1 d6 

s  1  d7 

=  s 1 *sc 1 d7 

sld8 

=  s 1 *sc 1 d8 

sld9 

=  s 1 *sc 1 d9 

sy  b  = 

sy  *scyb 

sy  r  = 

sy  *sb  *scyr 

syp  = 

sy *sb*scyp 

syd  1 

=  s y  *  cyd 1 

s  y  d  2 

=  sy*  cyd2 

sy  d3 

=  sy*  cyd3 

syd  4 

=  sy*  cyd4 

syd5  =  sy*  cyd5 
syd6  =  sy*  cyd6 
syd7  =  sy*  cyd7 
syd8  =  sy*  cyd8 
syd9  *  sy*  cyd9 


ur itee *,1661) 

1661  f  or  mate  5x  ,  '  1  at -d  ir  stab  axis  dimensional  der  iuat  iwes<  1/rad ) 1 ) 
ur  ite< * , 167 1 )  snb,slb,syb 


1671 

f ormat< 4x , 1 nb  =  '  , g  13 . 6 ,9x  ,  ’  1 b  = 
ur  ite<  *  ,  163 1 )  snp,slp,syp 

‘  ,g  13.6,5x , 'yb  = 

,g  13.6) 

1681 

formate  4x , 'np  =  '  ,g 13 . 6 ,9x , ' 1 p  = 
ur  ite< *  ,  169 1 )  snr,slr,syr 

'  , g 1 3 . 6 , 5x  ,  ' 

yp  = 

,g  13.6) 

1691 

for  mat<  4x  ,'  nr  =  '  ,g  13  .  b  ,9x  ,  •  1  r  = 

ur  ite< * ,  170 1 )  snd  1  ,s 1 d  1  ,sy d  1 

' , g 13.6, 5x  ,  ' 

yr  = 

,g  13.6) 

1701 

f ormat< 3x , 'nd 1  =  1  ,g  13 . 6  ,8x  ,  • 1 d 1 

ur  ite< *,1711)  snd2  ,s 1 d2 ,syd2 

=  *  ,  g  1 3 . 6 , 4x 

,  '  yd  1 

=  '  ,g  13 

1711 

for mat< 3x nd2  =  ' ,g 13 . 6 ,8x  ,  ’  1 d2 
ur ite< *, 172  1  )  snd3 ,s 1 d3  ,syd3 

=  '  ,g 13 . 6 ,4x 

,  's-d2 

=  ',913 

1721 

f ormate 3x , ' nd3  =  ' ,g 13 . 6 ,8x  ,  1 1 d3 
ur ite< *  ,  173  1  )  snd4  ,s 1 d4  ,syd4 

=  '  ,g  13 . 6 ,4x 

,  ’ y d3 

=  '  ,9  13 

1731 

for mate 3x nd4  =  ‘,gl3.6,8x,'ld4 

ur  itee  *  ,  174 1 )  snd5  ,s 1 d5 ,syd5 

=  1  ,g  13 . 6 ,4x 

,  ' y d4 

=  ’ ,9  13 

1741 

formate  3x ,  'nd5  =  1  ,g  13 . 6  ,8x  ,  '  1 d5 
ur  itee *,  175 1 )  snd6 ,s 1 d6 ,syd6 

=  1  , g  13 . 6 ,4x 

,  ’  y d5 

=  '  ,9  13 

1751 

formate 3x , 'nd6  =  •  ,g 1 3 . 6  ,8x  ,  • 1 d6 

ur  itee *,  176 1 )  snd7  ,s 1 d7 ,syd7 

=  '  ,g  13 . 6  ,4x 

,  1  y  d6 

=  ’,913 

1761 

f ormate 3x , 'nd7  =  '  ,g  13 . 6  ,8x  ,  •  1 d7 
uritee*,177l)  snd8,sld3,syd3 

=  '  ,g  13 . 6 ,4x 

,  'yd? 

=  ',913 

1771 

formate  3x , 'nd8  =  '  , g  1 3 . 6 , 8x  ,  ' 1 d 8 
ur  itee  *,  178 1 )  snd9  ,s 1 d9 ,syd9 

=  '  ,g  13 . 6 ,4x 

,  'yd3 

=  ',913 

1781 

f ormate 3x ,’ nd9  =  '  ,g  1 3 . 6  ,8x  ,  '  1 d9 

=  ,g  13 . 6 ,4x 

,  'yds 

=  ',913 

1650 
180  1 


ur  itee *  ,  1650 ) 

for  mat  <  lx, 1 ****************************************************'  ) 


cont  inue 

n  =  dpr  *<  q*s  *b  )/b  izz 

1  =  dpr*<  q*s  *b  )/b  ixx 

bb  =  b  /<  2 . 0 *u  ) 

y  =  dpr  *<  q*s  *32 .2  )/u 

bnb  =  n*cnb 

bnp  =  n*bb*cnp 

bnr  =  n*bb*cnr 

bnd  1  =  n  tend  1 

b  n  d  2  =  n  *c  n  d  2 

bnd3  =  n*cnd3 

bnd4  =  n*cnd4 

bnd5  =  n*cnd5 

bnd6  =  n*cnd6 
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bnd?  =  n*cnd7 
bnd8  =  n*cnd8 
bnd3  =  n*cnd3 

bib  -  1  *c  1  b 
b  1  p  =  1 *bb *c 1 p 
b 1 r  =  1  *bb  *c  1  r 
bid  l  =  1  *c 1 d  1 
bld2  =  l *c 1 dS 
bld3  =  1 *c 1 d  3 
b  I  d4  *  1  *c  1  d4 
bld5  =  l*cld5 
b 1 d6  «  l*cld6 
b 1 d7  =  1 *c 1 d7 
bldS  =  1  *c  1  d8 
b 1 d3  =  1  *c  1  dS 

byb  =  y*cyb 
byr  =  y*bb*cyr 
byp  =  y*bb*cyp 
byd  1  =  y  *cy d 1 
bydS  =  y*cydS 
byd3  =  y  *c  y  d  3 
byd 4  =  y*cyd4 
bydS  =  y*cyd5 
byd6  =  y*cyd6 
byd?  =  y*cyd7 
bydS  =  y*cyd8 
bydS  =  y*cydS 

wr  ite<  *  ,  1660 ) 

1660  formal  3x  ,  1  Ut-d  ir  body  axis  dimensional  der  ivat  ives(  1/rad)  '  ) 
ur  itee  *  ,  1670  )  bnb,blb,byb 

1670  formate  4x , 'nb  =  ' ,g 13 . 6 ,9x  ,  '  1 b  =  '  ,g  13 . 6  ,5x  ,  '  yb  =  ’,gl3.6> 
ur  ite<  *  ,  1680  )  bnp,blp,byp 

1680  formate  4x ,  'np  =  '  , 9 1 3 . 6 , 9x , ' 1 p  =  '  , g 1 3 . 6 ,5x  ,  ' y p  =  ’,gl3.6) 
ur  itee  *  ,  1690  )  bnr,blr,byr 

1690  formate  4x , 'nr  =  '  ,g  13 . 6  ,9x  ,  '  1  r  =  '  ,  g 1 3 . 6 ,5x  ,  '  y r  =  ’,913.6) 
ur  iteC  *  ,  1700 )  bnd  1  ,b 1 d  1  ,by d  1 

1700  formate  3x , 'ndl  *  ' , g 1 3 . 6  ,8x  ,  '  1 d I  =  '  ,  9 1 3 . 6 ,4x ,  '  y d  1  =  ',gl3.6> 
ur  it*< *,  1710)  bndS, bldS, bydS 

1710  formate 3x , ’nd2  =  * , g  1 3 . 6 , 8x  ,  1  1 d S  =  • ,g 13 . 6 , 4x , ’ y dS  =  ’,gl3.6) 
ur  it*<  * ,  1720 >  bnd3  ,t- 1  d3  ,byd3 

1720  f ormate 3x , ’nd3  =  ’ , g 1 3 . 6 , 8x ,  1 1 d3  =  1 , g 1 3 . 6 , 4x , 1 y d3  =  ’,913.6) 
ur  itee  *  ,  1  730  )  bnd4,bld4,byd4 

1730  f ormate 3x , ’nd4  =  ’ , g 1 3 . 6 , 8x  ,  ’  1 d 4  =  ’ ,g 13 . 6 ,4x , * y d4  =  ’,gl3.6) 
ur  it e<  * , 1740 >  bndS,bld5,byd5 

1740  formate  3x ,  ’nd5  =  ’  ,g  13 .6  ,8x  ,  ’  1 dS  =  ’ ,g 13.6 ,4x , ’yd5  =  ’,gl3.6) 

ur  iteC  *  ,  1750  >  bnd6,bld6,byd6 

1750  f ormate 3x , ’ndS  =  ’ ,g 13.6  ,8x , ’ 1 d6  =  ’ ,g 13 . 6 , 4x , ’ y d6  =  ’,gl3.6) 


!  <t 


ur  itee * ,  1760 )  bnd7 ,b 1 d7 ,byd7 

1760  f ormate 3x , * nd7  =  ' ,g 13 . 6 ,8x , ' 1 d7  =  1  ,g  13 . 6 ,4x , ' yd7  =  *,gl3.6) 
ur  itee a ,  1770 >  bnd3  ,b  1  dS  ,byd3 

1770  formate 3x , 'nd8  =  ' ,g 13 . 6 ,8x , ’ 1 d8  =  1 ,g 13 . 6 ,4x , 1 yd8  =  ‘,gl3.6> 
ur  itee a  ,  1780 >  bndS ,b 1 d3 ,by d3 

1730  -format*  3x  ,  'nd9  =  '  ,g  13 . 6  ,8x  ,  ’  1  d9  =  1  ,  g  13 . 6  ,4x  ,  1  y  d9  =  ',gl3.6> 
ur  itee  a ,  1790  > 

1790  -formate  lx,  1  ***************  ****************  **********  ***********  '  ) 
ur  itee  a  ,  1800 ) 

1800  -formate  lx , 1  a**********#****************************************' ) 


conversion  of  data  into  state  space  form 


d  =  1.0  -  e  e  b  ixz  ab  .xz  )/<  b  ixx  ab  izz  )  ) 
rl  =  bixz/bizz 
r  2  =  bixz/bixx 


pbnb  = 

pbnp  = 

pbnr  = 

pbnd  1 

pbnd2 

pbnd3 

Pbnd4 

pbnd5 

pbndG 

pbnd7 

pbndS 

pbndS 


e  bnb  + 
e  bnp  ♦ 
e  bnr  ♦ 
e  bnd  1 
e  bnd2 
e  bnd3 
e  bnd4 
e  bnd5 
e  bnd6 
e  bnd7 
e  bnd3 
e  bnd9 


r  1  *b  1  b  )  /d 
r 1 *b 1 p )/d 
rl*blr)/d 
♦  r lab  Id 1 >/d 
+  r  1  ab  1  d  2 )  /d 
+  r  1  ab 1 d3  >/d 
+  r  1  ab 1 d4 )/d 
+  r 1 ab 1 d5 )/d 
+  r 1 ab 1 d6 )/d 
+  r 1 ab 1 d7 )/d 
+  r 1 ab 1 d3 )/d 
+  r 1 ab 1 d9 )/d 


pblb  =  eblb  +  r2abnb )/d 
pblp  =  e  b lp  +  r2abnp)/d 
pblr  =  (b!r  +  r2tbnr)/d 
pbldl  =  ebldl  ♦  r2abnd 1 )/d 
Pbld2  =  e  b 1 d2  +  r2abndH )/d 
Pbld3  =  e  b 1 d3  ♦  r2abnd3 )/d 
Pbld4  *  ebld4  +  r2*bnd4)/d 
pbld5  =  ebldS  ♦  r2abnd5)/d 
pb 1 d6  =  e  b 1 d6  +  r2tbnd6 )/d 
Pbld7  =  ebld7  +  r2abnd7)/d 
pbldS  =  ebldS  +  r2abnd3)/'d 
Pbld9  =  e  b 1 d9  +  r2abnd9)/d 


P  b  y  b  = 
p  b  y  p  = 
P  b  y  r  = 


mm 
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xl^3lA 


b  v  b  /u 
s  a  1 
-c  a  1 


•  pbyphi  =  32.2*cth/u 
pbydl  =  bydl/u 
pbyd2  =  byd2/u 
pbyd3  =  byd3/u 
pbyd4  =  byd4/u 
pbyd5  =  byd5/u 
pbydS  =  byd6/u 
Pbyd7  =  byd7/u 
pbyd8  =  bydS/u 
pbydS  =  byd9/u 

?  lateral  directional  state  matrix 


do  1805  i = 1 , 5 
do  1806  j  = 1 ,5 
1806  d ir mate  i ,  j 5=0.0 
1805  cort inue 

d ir mat ?  1,35=1.0 
d irmat?  2,1) =pbyph  i 
dirmat<2,2)=pbyb 
dirmat?2,35=pbyp 
d irmatC 2,4)=pbyr 
d  irmat<  2 ,5 5 =32 . 2*sth/u 
dirmat?3,2)=pblb 
d irmat? 3 ,3  )  =pb 1 p 
d  irmat<  3 ,4  )  =pb  1  r 
d  irmat<  4,25=pbnb 
d irmat( 4 ,3  5  =pbnp 
d :rmat( 4,4)=pbnr 
d irmat?  5,4)  =  1.0 


output  the  state  matrix 


uir  ite?  *  ,830  5 
ur  ite? * , 13105 

1810  format?  '  1  '  ,2x  ,  ' 1 ater al  directional  state  matrix') 
write? * , 1320  5 

1320  format?  '0' ,5x, 'states  =  phi,beta,p,r,psi'5 
ur ite?  * , *  5 

write?  *,18255  <dirmat?  l,i),i  =  l,5) 
write?  *,1325)  <dirmat<2,i),i  =  l,55 
write?  *,1825)  ?dirmat?3,i),i  =  l,5) 
write?  *,1325)  ?  d ir mat?  4 , i 5 , i  =  1 ,5  5 
write?  *  ,  1825  >  ?dirrnat?5,i),i  =  l,5) 
write?  *  ,  *  5 

1325  format?  '0 '  ,2x  ,5? g 1  1 . 4 ,4x 5  5 


lateral  directional  input  matrix 


do  1830  i=l,9 
dirbmat?  l,i>=0.0 
d  ir bmat  ?5,i>=0.0 

1830  continue 

d  ir  bmat?  2, 1  )  =  p by d  1 
d irbmat<  2,2)=pbyd2 
dirbmat?2,3)=pbyd3 
d irbmat<  2,4)=pbyd4 
dirbmat(  2,5)=pbyd5 
dirbmat?2,6)=pbyd6 
dirbmat?2,7)=pbyd7 
d  ir  bmat?  2,3)=pbyd8 
d i r b ma t  ?  2,9)=pbyd9 
d i  r  b  mat  ?  3, 1 ) =p  b  n  d 1 
d irbmat? 3,2)=pbnd2 
d i r b mat ?  3,3)=pbnd3 
dirbmat?3,4)=pbnd4 
d  irbmat?3,5)=pbnd5 
d irbmat?  3,6)=pbnd6 
d i r b ma t  ?  3,7)=pbnd7 
d  irbmat?  3,8)=pbnd8 
d irbmat< 3,9)=pbnd3 
d ir bmat?  4,l)=pbldl 
d irbmat?  4,2)=pbld2 
d irbmat?  4, 3)=pbld3 
dirbmat?4,4)=pbld4 
d irbmatf 4,5)=pbld5 
d irbmat?  4,6)=pbld6 
d  irbmat?  4,7)=pbld7 
d irbmat?  4,8)=pbld8 
d irbmat?  4,9)=pbld9 

P-int  out  the  input  matrix 

writer  *  ,  1350  ) 

1359  format?  '  0  '  ,2x  ,  '  1  at  e  r  a  1  directional  input  matrix') 
write?  *  ,  1860  ) 

1860  for mat ?  '0',4x,'for  inputs:  dell=rudder,del2=diff  can') 
write?  * ,  1370 ) 

1870  format?  6x , ' de 1 3 =d  i f f  stab,  del4=diff  ail,  del5=diff  tef  '  ) 
wr  ite< *,  1380) 

1380  f or mat ? 6x , ' d e  1  6  to  9  are  reuerser  vane  ports') 
write?  *  ,  1390 ) 

1890  format?  '0'  ,5x,  'roul  '  ,  1  lx  ,  'rou2'  ,llx,  'row3 ’  ,llx,  'row4'  ,llx,  'rou5'  ) 
do  1900  i  =  1  ,3 

write?  *,1825)  ?d  irbmat?  j,i),j=l,5) 
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APPEND  IX  B  STOL  F-15  AERODYNAMIC  DATA 


B.l  LONGITUDINAL  AND  LATERAL  DATA:  MACH  0.3  AT  20,000  FEET 


**************************************************** 
aircraft  parameters 

q  Cdynamic  pressure  -  lbs/ft**2)  =  61.3430 

s  Cuing  reference  area  -  ft**2)  =  608.000 

c  Cuing  mean  aerodynamic  cord  -  f  t  )  =  15.9400 

b  Cuing  span  -  ft)  =  42.7000 

vt  C tr im  velocity  -  ft/sec)  =  311.178 

theta  =  12.2435 

u  Cueight  -  lbs)  =  377334. 

ixx  C  s 1 ug -f t  **2  )  =  25938.0 

iyy  Cslug-ft**2)  =  185287. 

izz  C  s 1 ug -f t  **2  )  =  206353. 

ixz  Cslug-ft**2)  =  -2543.00 

**************************************************** 


alpha  =  12.2435 

longitudinal  non-dim  body  axis  coef f ic ientsC  1/deg) 


cza  =  -,734180e-01 

cma 

= 

. 426440e -02 

exa 

= 

-. 197 155e -02 

CZq  =  0  . 

cmq 

= 

-. 156080 

exq 

= 

0. 

czh  =  . 636483e -04 

cmh 

= 

- . 278 182e -04 

exh 

= 

. 959477e -03 

czu  =  - . 1 28400e -0 1 

emu 

= 

-.561 187e -02 

exu 

= 

193560 

czd 1  =  - . 308325e -02 

cmd  1 

= 

. 649500e -02 

cxd  1 

= 

- . 83 1577e -03 

czdH  =  - .  1096 19e -0  1 

cmd2 

= 

-.  1  1 4632e -0  1 

cxd2 

= 

- . 1 4S560e -02 

c  z  d  3  =  - . 343080e -02 

cmd  3 

= 

- . 365 1 30e -02 

c  x  d  3 

= 

. 592350e -04 

czd4  =  - . 342080e -02 

cmd  4 

= 

- . 355 180e -02 

c  x  d  4 

= 

. 592340e -04 

czd5  =  0 . 

c  md  5 

= 

0  . 

c  x  d  5 

= 

0  . 

czd6  =  0. 

c  md  6 

= 

0  . 

cxd6 

= 

0. 

czd7  =  0 . 

cmd  7 

= 

0  . 

cxd  7 

= 

0  . 

czd3  =  0. 

cmd  3 

= 

0. 

c  x  d  S 

= 

0  . 

**************************************************** 

longitudinal  axis 

d imens ional 

der  ivat  ives 

body  ax 

is  Cl /rad) 

za  =  -14.4801 

ma 

= 

. 783953 

x  a 

= 

-.359468 

zq  =  0 . 

mq 

= 

- . 734905 

xq 

= 

0  . 

zh  =  . 650889e -06 

mh 

= 

-  . 286S35e -06 

xh 

= 

.98 1 194e -05 

zu  =  - . 2626 1 2e -03 

mu 

= 

- . 1 1 5729e -03 

x  u 

= 

- . 395S82e -02 

zdl  =  -.563073 

md  1 

= 

1  .  19403 

xd  1 

= 

-.151619 

md2 

md3 


-£. 10737 
-.671339 


xd2 

xd3 


£67£  19 


zd£  =  -1.99865 

zd3  =  -.683705 

. 10300£e -0 1 


zd4  = 

-.633705 

md4 

= 

-.671339 

xd4 

. 103000e 

-01 

zd5  = 

0. 

md5 

= 

0. 

xd5 

zd6  = 

0. 

md6 

= 

0. 

xd6 

zd7  = 

0  . 

md  7 

= 

0. 

xd7 

zd8  = 

0. 

md8 

= 

0  . 

xd8 

*************  *******************************  ******** 


0. 

0. 

0. 

0. 


longitudinal  state  matr  ix(  body 


ax  is  ) 


for  state l=u ,state2=q,state3=alpha,state4=theta 


395883e -0£ 

-65.9905 

-.359468 

-31.4676 

1 157£9e -03 

- . 734905 

.733958 

0. 

843930e -06 

.977355 

-  .  46533 le -0 1 

- . 3 1944£e -0  1 

1 . 00000 

0. 

0. 

longitudinal  input  matrix 

for  de 1 1 =c anard ,de 1 £=st ab  ,de 1 3  =  t ef  ,de 1 4=dr  aileron 
del5=rt  rv,  del6=rb  rv,  del7=lt  rv,  del8=lb  rv 


rowl  row2 

row3 

row4 

-.151619  1.19403 

-. 130949e -03 

0. 

- . 3673  19  -3 .  10737 

- . 643387e -02 

0. 

. 108003e -0 1  -.671339 

- . 300434e -03 

0. 

. 103000e -0 1  -.671339 

- . 300434e -02 

0. 

0.  0. 

0. 

0. 

0  .  0  . 

0*. 

0. 

0.  0. 

0  . 

0. 

0.  0. 

0  . 

0. 

longitudinal  axis  dime  ns 

ional  derivatives 

stability  ax  is 

C  1/rad  ) 

za  =  -13.4300 

ma  =  . 75633S 

xa 

= 

-3.00916 

Zq  =  0  . 

mq  =  -.734905 

xq 

= 

0. 

zh  =  . 3  13307e -04 

mh  =  .  10 1375e  - 

05 

xh 

= 

5 1 543e -04 

zu  =  - . 880393e -03 

mu  =  .  408016e- 

03 

xu 

= 

6  1  1 437e -03 

zdl  =  -.513113 

md 1  =  1 . 13403 

xd  1 

= 

-.367580 

zd3  =  -1.89653 

md£  =  -2.10737 

xdS 

= 

-.634939 

z  d  3  =  -.611810 

md  3  =  -.671339 

x  d  3 

= 

-. 131713 

2  d  3  =  0  .  md  3  = 

************************  ********* 

0. 

****************** 

xd8 

0 . 

1  at -d ir  body  ax 
clb  =  -.254330e-02 

is  coef f  ic  ients 

c  nb  =  -  .  433366e -03 

cy  b 

- 

. 167 190e -0 1 

clp  =  - . 534782e -02 

cnp  = 

- . 232644e -02 

cyp 

_ 

0. 

dr  =  .  382S30e  -02 

cnr  = 

- . 393797e -02 

cyr 

= 

0. 

cldl  =  .742100e-04 

end  1  = 

-.  1440 10e -02 

cyd  1 

= 

3 1 7730e -02 

cld2  =  185490e-04 

cnd2  = 

.  565260e -03 

cy  d2 

= 

13 1870e -02 

cld3  =  . 885870e -03 

cnd3  = 

. 363420e -03 

cy  d3 

_ 

. 10 1060e -02 

cld4  =  . 683 140e -03 

cnd4  = 

. 633620e -04 

cyd4 

_ 

. 345490e -04 

cld5  =  .711 050e -03 

cnd5  = 

0. 

cyd5 

_ 

0. 

cld6  =  . 1844 10e -03 

cnd6  = 

0  . 

cy  d6 

= 

0. 

cld7  =  -. 1844 10e -03 

cnd7  = 

0. 

cy  d7 

= 

0. 

cld3  =  0. 

cndS  = 

0. 

cyd8 

= 

0. 

c 1 d9  =  0. 

cnd9  = 

0. 

cyd9 

= 

0. 

*************************************************** 
lat-dir  stab  axis  coetf  ic  ients 
clb  =  - .  253796e  -02  crib  =  .668776e-04 

! 

cyb 

. 167 190e -0 1 

clp  =  -.51 9803e -02 

cnp  = 

-.31 3802e -02 

cyp 

_ 

0. 

clr  =  . 30 1672e -02 

cnr  = 

- . 903776e -02 

cyr 

= 

0. 

cldl  =  - . 232375e -03 

c  n  d  1  = 

-  .  1 42303e -02 

cyd  1 

= 

3 1 7730e -02 

c 1 d2  =  . 10 174Se -03 

c  n  d  2  = 

. 556337e -03 

cy  d2 

_ 

131370a -02 

c 1 d  3  =  .3433516-03 

cnd3  = 

.  172 1 77e -03 

c  y  d  3 

_ 

. 10 1060e -02 

cld4  =  . 68 1 1 45e -03 

cn  d  4  = 

- . 8246 1 8e -04 

cyd4 

_ 

. 845490e -04 

cld5  =  . 684377e -03 

cnd5  = 

- . 15O790e -03 

cyd5 

_ 

0. 

cld6  =  . 1 802 16e -03 

cnd6  = 

- . 39 1 072e -04 

cy  d6 

= 

0. 

cld7  =  -. 1802 16e -03 

cnd7  = 

.391072e-04 

cy  d7 

= 

0. 

cld3  =  0. 

ends  = 

0. 

cydS 

= 

0  . 

cld9  =  0. 

cnd9  = 

0. 

cyd9 

= 

0. 

lat-dir  stab  axis  dimensional  i 
nb  =  . 309923e -0 1  lb  = 

der  ivat  ioesC  1/rad ) 

-6 . 72659 

yb 

-3.04333 

np  =  -.936268e-01 

1 P  = 

-.326969 

y  p 

= 

0. 

nr  =  -.283521 

1  r  = 

.537975 

yr 

= 

0. 

ndl  =  -.653510 

Id  1  = 

- . 605287 

yd  1 

= 

.579309 

n  d  2  =  .257436 

1  d2  = 

. 264456 

y  d£ 

= 

.  £40435 

nd3 

= 

. 79672 le -01 

1  d3 

= 

2.45325 

y  d3 

= 

134260 

nd4 

S 

- . 38 1530e -0 1 

1  d  4 

= 

1 .77042 

y  d4 

= 

-. 154 156e 

-01 

nd5 

= 

- . 697758e -0 1 

1  d5 

= 

1 .80612 

y  d5 

= 

0. 

nd6 

= 

-.  180963e -0  1 

1  d£ 

= 

.463414 

yd6 

= 

0. 

nd  7 

= 

. 1 80963e -0 1 

1  d  7 

= 

-.463414 

yd7 

= 

0. 

nd3 

= 

0. 

1  d3 

= 

0. 

yd8 

= 

0. 

nd9 

= 

0. 

1  d9 

= 

0. 

yd9 

= 

0. 

**************************************************** 

lat-dir  body  axis 

d imens ional 

derivatives':  1/rad) 

nb 

= 

-.213733 

1  b 

= 

-3.94706 

yb 

= 

-3 

.04833 

np 

= 

- . 705792e -0 1 

1  p 

= 

-1.29077 

yp 

= 

0. 

nr 

= 

-.271 159 

lr 

= 

.924012 

yr 

= 

0. 

nd  1 

= 

-.636778 

Id  1 

= 

.261063 

yd  1 

= 

579309 

nd2 

= 

.249945 

1  d2 

= 

- . 652534e -0  1 

yd2 

= 

240435 

nd3 

= 

.  162907 

1  d  3 

= 

3. 1 1640 

yd3 

= 

184260 

nd4 

= 

. 282383e -0 1 

1  d4 

= 

2.40321 

y  d4 

= 

-.  154 156e 

-01 

nd5 

= 

0. 

ld5 

= 

2.50140 

y  d5 

= 

0. 

nd6 

= 

0. 

1  d6 

= 

.643735 

yd6 

= 

0. 

nd7 

= 

0. 

1  d7 

= 

-.648735 

yd7 

= 

0. 

nd3 

= 

0. 

1  d3 

= 

0. 

yd8 

= 

0. 

n  d  9 

= 

0. 

1  d9 

= 

0. 

yd9 

= 

0. 

**************************************************** 
lateral  directional  state  matrix 


states  =  phi  ,beta,p  ,r  ,ps  i 


0. 

0. 

1.000 

0. 

0. 

.1011 

-  . 9796e -02 

.2121 

-.9773 

.  2 194e -0 1 

0. 

-8.937 

-  1 .235 

.9517 

0. 

0. 

-. 1036 

- . 5474e -0 1 

-.2829 

0. 

0. 

0. 

0. 

1  .000 

0. 

lateral  directional  input  matrix 

for  inputs:  de 1 1 =r u dd er ,d e 1 2 =d  i  f f  can 
de 1 3  =d iff  stab,  del4=diff  ail,  del5=diff 
del6  to  9  are  reverser  vane  ports 
roul  roue  rou3 


0. 

0. 

0. 

0. 

0. 

0. 

0. 


1362e -02 
7727e -03 
592 le -03 
4954e -04 


6408 
25  1  1 
1247 

l 373e -02 
3036e -0 1 
S004e -02 
3004e -02 


tef 


r  ou4 
,3239 

- . S987e -0 1 
3,  104 
2.403 
2 . 504 
.6495 
-.6495 


rou5 

0 . 

0. 

0. 

0. 

0. 

0. 

0. 


0 

0 

0 


B . 2  LONGITUDINAL  AND  LATERAL  DATA:  MACH  0.9  AT  90,000  FEET 


***************************************************** 
aircraft  parameters 

q  (dynamic  pressure  -  lbs/ft**2)  =  551.440 

s  (wing  reference  area  -  ft**2)  =  603.000 

c  (wing  mean  aerodynamic  cord  -  ft)  =  15.9399 

b  (wing  span  -  ft)  =  42.7000 

vt  (trim  velocity  -  ft/sec)  =  933.530 

theta  =  1.22396 

u  (weight  -  lbs)  =  37794.2 

ixx  (slug-ft**2)  =  25938.0 

iyy  (slug -ft  **2 )  =  185237. 

izz  ( s 1 ug -f t  **2 )  =  206359. 

ixz  (slug-ft**2)  =  -2543.00 

**************************************************** 
alpha  =  1.22897 


long  itud  inal  non 

-dim 

body  ax  is 

coef f  ic  ients( 

1  /d  e  g  ) 

cza  =  - . 852800e -0 1 

cma  = 

. 6542 10e -02 

exa 

S 

. 170230e -02 

czq  =  0 . 

cmq  = 

-. 141700 

exq 

s 

0. 

czh  =  . 787600e -05 

cmh  = 

- . 5666 10e -04 

exh 

= 

. 434250e -03 

czu  =  -.529610e-03 

emu  = 

- . 33 1020e -02 

exu 

- . 292000e -0 1 

czd 1  =  - . 253 1 40e -02 

cmd  1  = 

. 709040e -02 

cxd  1 

* 

. 872020e -04 

czdH  =  -.  106930e -0  1 

cmd2  = 

-.  1 19 130e -0  1 

cxd2 

= 

- .608630e -03 

CZd3  =  - . 643700e -03 

cmd  3  = 

-.  1 02230e -02 

cxd3 

= 

- . 103 160e -04 

czd4  =  - . 643700e -03 

cmd  4  = 

-.  102230e -02 

cxd4 

= 

- . 103 160e -04 

czd5  =  0 . 

cmd  5  = 

0. 

cxd5 

0. 

czd6  =  0 . 

cmd  6  = 

0. 

cxd6 

0. 

czd7  =  0 . 

cmd  7  = 

0. 

cxd7 

= 

0. 

czd3  =  0 . 

cmd3  = 

0. 

cxd3 

0  . 

**************************************************** 

longitudinal  axis 

dimensional  derivatives 

body  ax 

is  ( 

1/rad  ) 

za  =  -1395.73 

ma  - 

10.8143 

x  a 

=: 

27.8633 

Zq  =  0  . 

mq  = 

-  1 .99977 

xq 

0. 

zh  =  . 240996e -05 

mh  = 

-  .  175 1 12e -05 

xh 

. 1 32375e -03 

zu  =  - . 324 1 09e -03 

mu  = 

- . 2355 10e -03 

XU 

= 

- . 178697e -0 1 

zdl  =  -42.2434 

md  1  = 

1  1 .7207 

xd  1 

= 

1 .42719 

z  d  2  =  -175,039 

md2  = 

-19.6926 

xd2 

= 

-9.961  13 

z  d  3  =  -10.5351 

md3  = 

-1 .63990 

xd3 

= 

- . 1 68837 

zd4 

= 

-10.5351 

md  4 

= 

-1.68930 

xd4 

= 

-. 168837 

zd5 

= 

0. 

md5 

= 

0. 

xd5 

= 

0. 

zd6 

* 

0. 

md  6 

= 

0. 

xd6 

= 

0. 

zd7 

= 

0. 

md  7 

= 

0. 

xd7 

= 

0. 

zdS 

= 

0. 

md8 

= 

0. 

xd8 

= 

0. 

**************************************************** 

longitudinal  state  matr ix< body  axis) 
for  statel=u,state2=q,state3=alpha/state4=theta 

- . 1 78697e -0 1  -20.0223  27.8638  -32.1326 

- . 2355 10e -03  -1.89377  10.8143  0. 

- . 347 136e -06  .933770  -1.49511  -.739792e-03 

0.  1.00000  0.  0. 


longitudinal  input  matrix 

for  de 1 1 =c anard ,de 1 2=s t ab ,de 1 3=t ef  ,de 1 4 =dr  aileron 
del5=rt  rv  ,  del6=rb  rv  ,  del7  =  lt  rv,  del8  =  lb  rv 


r  oui  1 


rou2 


rou3 


r  ou4 


1 .42719 
-9.36113 
-.  163337 
-.  163337 
0. 

0. 

0. 

0. 


I  1.7207 
-19.6926 
- I . 63990 
-1.68930 
0. 

0. 

0. 

0. 


,452566e-01 
,  187555 
.  1 12352e -0 1 
.  1 1 2852e -0 1 


0, 
0, 
0. 
0  . 


0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 


longitudinal  axis  dimensional  derivatives 
stability  axis  <  1/rad) 


z  a  = 

-1335.37 

ma 

= 

10.8141 

xa 

= 

-1.71436 

zq  = 

0. 

mq 

= 

-  1 . 99977 

xq 

= 

0. 

zh  = 

. 237332e -03 

mh 

= 

. 96267Se -07 

xh 

= 

1 33220e - 

03 

zu  = 

- . 320063e -0 1 

mu 

= 

. 1 £9472e -04 

XU 

= 

.  179 160e 

-01 

zd  1  = 

-42.2693 

md  1 

= 

1 1 . 7207 

xd  1 

= 

.520720 

zd2  = 

-174.335 

md2 

= 

-19.6926 

xd2 

= 

-13.7141 

zd3  = 

-10.5291 

md  3 

= 

-1 .68990 

xd3 

= 

-.394754 

zd4  = 

-10.5291 

md  4 

= 

-1 .63930 

xd4 

= 

-.394754 

zdS  = 

0. 

md  5 

= 

0. 

xd5 

= 

0. 

zd6  = 

0. 

md6 

= 

0. 

xd6 

= 

0. 

zd7  = 

0. 

md7 

= 

0. 

x  d  7 

= 

0. 

zdS  = 

0  . 

md3 

= 

0. 

xdS 

= 

0. 

**************************************************** 


237£00e -02 


cyb 


c 


lat-dir  body  axis  coef-f  ic  ienis 
clb  =  - . 122900e -02  cnb  = 

- . 2 10360e -0  i 


ClP  =  - . 5 I2830e -02 

cnp  = 

- . 203200e -03 

cyp 

= 

0. 

clr  =  . 107820e -02 

cnr  = 

- .  3S5630e -02 

cyr 

= 

0. 

cldl  =  . 38 1 080e -04 

end  1  = 

-. 124030e -02 

cy  d  1 

S 

234 130e -02 

c ld2  =  -. 107000e -03 

cnd2  = 

. 435700e -03 

cy  d2 

= 

552720e -03 

cld3  =  . 738040e -03 

cnd3  = 

. 502250e -03 

cy  d3 

= 

127680e -02 

cld4  =  . 342770e -03 

c  n  d  4  = 

. 672630e -04 

cy  d4 

= 

•.  145770e  -03 

cld5  =  . 662000e -03 

cnd5  = 

0. 

cy  d5 

= 

o. 

cld6  =  . 9 104 10e -04 

cnd6  = 

0. 

cy  d6 

= 

0. 

cld7  =  - . 9 104 10e -04 

end?  = 

0. 

cy  d7 

= 

0. 

cldS  =  0. 

end  8  = 

0. 

cyd9 

= 

0. 

cld9  =  0. 

cnd3  = 

0. 

cyd9 

SB 

0. 

*********  ******************************************* 

la-t-dir  stab  axis  coefficients 
clb  =  -.11 7776e -02  cnb  =  .240181e-02  cyb 

- . 2 10360e -0 1 

cIp  =  - . 5 1 1 1 1 6e -02 

cnp  = 

- . 2?9253e -03 

cyp 

= 

0. 

clr  =  . 1002 15e -02 

cnr  = 

- .  867344e -02 

cyr 

= 

0. 

Cldl  =  .1  1 4974e -04 

end  1  = 

-. 124083e -02 

cyd  1 

= 

,  284 1 30e -02 

cld2  =  - . 976305e -04 

cnd£  * 

. 437895e -03 

cyd2 

= 

,  552720e -03 

cld3  =  . 79863 le -03 

c  nd  3  = 

. 485233e -03 

cyd3 

= 

1 27630e -02 

cld4  =  . 344 1 34e -03 

c  n  d  4  = 

. 598958e -04 

cy  d4 

= 

- .  145770e -03 

cld5  =  . 66  1848e -03 

cnd5  = 

-.  14 1985e -04 

cy  d5 

= 

0. 

cld6  =  . 9 1020 le -04 

cnd6  = 

- . 195264e -05 

cy  d6 

= 

0. 

cld7  =  -.91 020 1 e -04 

end?  = 

. 1 35264e -05 

cyd7 

= 

0. 

cld8  =  0. 

c  n  d  3  = 

0  . 

cy  d3 

= 

0. 

cld9  =  0. 

cnd9  = 

0. 

cyd9 

= 

0. 

1  at -d  ir  stab  ax  is 

nb  =  9.55592 

d i me n s i o n a  1  d e r  i v at  i v e s <  1/rad ) 

lb  =  -36.8716  yb 

-345. 104 

np  =  - . 254093e -0 1 

1 P  = 

-3.66945 

yp 

= 

0. 

nr  =  -.789213 

lr  = 

. 719470 

yr 

= 

0. 

ndl  ■  -4.93631 

Id  1  = 

.360920 

yd  1 

= 

46.5021 

nd2  =  1.74222 

1  d  2  = 

-3.06477 

yd2 

= 

9.04608 

nd  3  =  1.3305S 

1  d3  = 

25.0702 

yd3 

= 

-20.8967 

nd4  =  .238303 

1  d4  = 

10.8029 

y  d4 

= 

-2.38574 

nd5  =  -.564907e-0I 

1  d  5  = 

20.7764 

y  d5 

= 

0. 

nd6  =  - . 776833e -02 

1  d6  = 

2.35726 

y  d6 

as 

0. 

nd7  =  .7768S3e-02 

Id?  = 

-2.85726 

yd? 

= 

0. 
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********************************** 
lat-dir  body  axis  dimensional  der  iuat  iwes(  1/rad) 


nb 

= 

9.44442 

lb 

= 

-38.8658 

yb 

= 

-345. 104 

np 

= 

134724e -01 

1  p 

= 

-3.70902 

yp 

= 

0. 

nr 

= 

-.786920 

1  r 

X 

.779803 

yr 

0. 

nd  1 

X 

-4.93010 

Id  1 

= 

1.20512 

yd  1 

= 

46.5021 

nd2 

= 

1.73187 

1  d2 

= 

-3.38376 

yd2 

= 

9.04608 

nd3 

= 

1 .9364  1 

1  d3 

= 

24.9203 

yd3 

= 

-20.8967 

nd4 

= 

.267365 

1  d4 

= 

10.8397 

y  d4 

= 

-2.38574 

nd5 

= 

0. 

1  d5 

= 

20.9350 

yd5 

= 

0. 

nd6 

= 

0. 

1  d6 

= 

2.87907 

yd6 

= 

0. 

nd7 

= 

0. 

1  d7 

= 

-2.37907 

y  d7 

= 

0. 

nd8 

= 

0. 

ld8 

= 

0. 

y  d  8 

= 

0. 

nd9 

= 

0. 

1  d9 

= 

0  . 

yd9 

X 

0. 

**************************************************** 
lateral  directional  state  matrix 
states  *  phi,beta,p,r,psi 


0. 

0. 

1 .000 

0. 

. 3443e -0 1 

-.3697 

. 2 145e -0 1 

-.9998 

7398e -03 

0. 

-39.84 

-3.712 

.8580 

0. 

9.935 

.  2727e -01 

-.7975 

0. 

0. 

0. 

1.000 

lateral  directional  input 

matr  ix 

for  inputs! 

del  1  =r udder , 

de  1 2 

=diff  can 

de 1 3=d  iff 

stab,  del4=d  iff 

ail,  del5=diff 

tef 

de 1 6  to  9 

are  reuerser 

wane  ports 

row  1 

ro«2 

row3 

r  ow4 

0. 

. 498  1  e -0 1 

-4.951 

1.691 

0. 

.  9690e -02 

1 .776 

-3.553 

0. 

- . 223Se -0 1 

1.631 

24.76 

0  . 

- . 2556e -02 

.  1339 

10.33 

0. 

0. 

-  .  2533 

20.96 

0. 

0  . 

- . 3552e -0 1 

2.833 

0. 

0. 

.35526 -01 

-2.383 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

r  ow5 
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6 . 3  LONGITUDINAL  AhC  LATERAL  OATA:  MACH  1 . 4  AT  20,000  FEET 


**************************************************** 
aircraft  parameters 

q  (dynamic  pressure  -  lbs/ft**£)  =  1335.91 

s  < u  ing  reference  area  -  ft**2)  =  608.000 

c  (wing  mean  aerodynamic  cord  -  ft)  =  15.9399 

b  (wing  span  -  ft)  =  42.7000 

vt  (trim  velocity  -  f t/sec )  =  1452.66 

theta  =  182000 

u  (weight  -  lbs)  =  37794.2 

ixx  ( s 1 ug -f t  **2  )  =  25933.0 

iyy  ( s 1 ug -f t  **2 )  =  185287. 

izz  (slug -ft  **2  )  =  206359. 

ixz  ( slug-ft#*2)  =  -2543.00 

**************************************************** 
**************************************************** 
alpha  =  -. 182000 

longitudinal  non-dim  body  axis  coeff  ic  ients(  1/deg ) 
cza  =  - . 654530e -0 1  cma  =  -,134490e-01  cxa  = 

. 108250e -02 


CZq  =  0. 

cmq 

= 

-.256400 

CXq 

= 

0. 

czh  =  . 330080e -03 

cmh 

= 

. 303330e -03 

exh 

= 

. 424060e -03 

czu  =  - . 1 42680e -0 1 

emu 

= 

.  133280e -0 1 

exu 

= 

-. 183300e -0 1 

czdl  =  -.800000e-03 

cmd  1 

* 

. 33 1630e -02 

cxd  1 

= 

. 267760e -04 

czd2  =  - . 692730e -02 

cmd2 

= 

- . 836780e -02 

cxd2 

= 

- .536760e -03 

czd3  =  - . 889950e -03 

cmd  3 

= 

-. 1 86670e -02 

cxd3 

= 

- . 337350e -04 

CZd4  =  -.8899606-03 

cmd  4 

= 

-. 136670e -02 

cxd4 

= 

- . 337950e -04 

czd5  =  0. 

cmd  5 

= 

0. 

cxd5 

= 

0. 

czd6  =  0. 

cmd  6 

= 

0. 

cxd6 

= 

0. 

czd7  =  0. 

cmd  7 

= 

0. 

cxd7 

= 

0. 

czdS  »  0. 

cmd  8 

= 

0. 

cxd3 

= 

0. 

**************************************************** 

longitudinal  axis 

d imens ional 

derivatives 

body  ax 

is  (1/rad) 

z  a  =  -2595 . 36 

ma 

= 

-53.8436 

xa 

= 

42.9203 

zq  =  0  . 

mq 

= 

-5.63183 

xq 

= 

0. 

zh  =  . 1 5724£e -03 

mh 

= 

.  1433 1 le -04 

xh 

= 

.2020 1 le -03 

zu  =  -. 1 35939e -0 1 

mu 

= 

. 1282 1 9e -02 

XU 

= 

-. 1 74639e -0 1 

zdl  =  -31.7194 

md  1 

= 

13.2769 

xd  1 

= 

1 .06165 

zd2  =  -274.662 

md2 

= 

-33.5003 

xd2 

= 

-21.2821 

zd3  =  -35 . 2858 

zd4  =  -35.2362 

zdS  =  0. 

zd6  =  0. 

zd7  =  0. 

zdS  =  0. 


md3  =  -7.47341 

md4  =  -7.47341 

md5  =  0. 

md  6  =  0 . 

md7  =  0 . 

md  3  =  0 . 


x  d  3  =  -1.33395 

xd4  =  -1.33335 

xd5  =  0. 

xd6  =  0. 

xd7  =  0. 

xd3  =  0. 


**************************************************** 
longitudnal  state  matr  ix<  body  axis) 

•for  state  I=u,state2=q,state3  =  alpha,state4  =  theta 


-. 174633e -0 1 
. 1282 13e -02 
- . 335787e -05 
0. 


4.61437 
-5.63188 
.333335 
1 . 00000 


42.3203 
-53.8436 
-1 .78663 
0. 


-32. 1338 


.  704109e -04 


longitudnal  input  matrix 

for  del l=canard  ,del2=stab  ,de!3=tef  ,del4=dr  aileron 
del5=rt  rv,  del6=rb  rv  ,  del7  =  lt  rv  ,  del8  =  lb  rv 


1.06165 
-21 .2821 
-1.33335 
-1 .33335 


rou2 

13.2769 

-33.5008 

-7.47341 

-7.47341 


r  ou3 

- . 2 13354e -0 1 
-. 189075 
-  . 242905e -0 1 
- . 242908e -0 1 
0. 

0. 

0. 

0. 


longitudinal  axis  dimensional  derivatives 
stability  axis  <  1/rad) 


za  = 

-2535.25 

ma 

= 

-53.8371 

xa 

= 

51 .0333 

zq  = 

0. 

mq 

= 

-5.63188 

xq 

= 

0. 

zh  = 

. 922333e -04 

mh 

= 

. 1 6 1 929e -04 

xh 

= 

202804e - 

03 

zu  = 

- . 797430e -02 

mu 

= 

. 139992e -02 

XU 

= 

. 1 75324e 

-01 

zd  1  = 

-31 .7158 

md  1 

= 

13.2763 

xd  1 

= 

1 . 16240 

zd2  = 

-274.723 

md  2 

= 

-33.5003 

xd2 

= 

-20.4095 

z  d  3  = 

-35.2333 

md3 

= 

-7.47341 

xd3 

= 

-1 .22785 

z  d  4  = 

-35.2903 

md  4 

= 

-7.47341 

xd4 

= 

-1 .22785 

v  Y 


* 


V 


c 


0 


V 


V 


i 


z  d  8  =  0 .  md  8  =  0 .  xd8=0. 

**************************************************** 


lat-dir  body  axis  coef-f  ic  ients 


clb  =  - . 647440e -03 

cnb 

S 

. 946930e -03 

cyb 

= 

1654 10e -0 1 

clp  =  - . 55 1 230e -02 

cnp 

= 

. 156840e -04 

cyp 

= 

0. 

c 1 r  =  . 9 10530e -03 

cnr 

= 

-. 153450e -0 1 

cyr 

= 

0. 

Cldl  =  . 292080e -04 

end  1 

= 

- . 364720e -03 

cy  d  1 

= 

. 7479 10e -03 

cld2  =  - . 562730e -03 

cnd2 

= 

. 435740e -04 

cyd2 

= 

. 365 1 30e -03 

Cld3  =  . 666430e -03 

cnd3 

= 

5.37130 

cy  d3 

= 

- . 452300e -03 

cld4  =  . 455370e -04 

cnd4 

= 

. 429460e -05 

cy  d4 

= 

-. 18 1700e -04 

cld5  =  . 6?5220e -03 

cnd5 

= 

0. 

cyd5 

= 

0. 

cld6  =  . 346 180e -04 

cnd6 

= 

- . 695530e -06 

cyd6 

= 

0. 

cld7  *  - . 346 1 70e -04 

cnd7 

- 

. 695530e -06 

cy  d7 

= 

0. 

cld8  =  0. 

cnd8 

= 

0. 

cyd8 

= 

0. 

cld9  =  0. 

cnd9 

= 

0. 

cy  d9 

0. 

**************************************************** 


lat-dir  stab  axis  coefficients 


clb  = 

- . 650445e -03 

cnb 

. 944869e -03 

cyb 

= 

-. 1654 10e 

-01 

Clp  = 

- . 55 1534e -02 

cnp 

= 

. 469030e -04 

cyp 

= 

0. 

dr  * 

. 94 1804e -03 

cnr 

= 

-.  153420e -01 

cyr 

= 

0. 

cldl  = 

. 303664e -04 

end  1 

= 

- . 364625e -03 

cyd  1 

= 

. 7479 10e  - 

03 

cld2  = 

- . 562S66e -03 

cnd2 

= 

.41 7863e -04 

cy  d2 

= 

. 365 1 30e  - 

03 

c  1  d  3  = 

-. 163955e -0 1 

cnd3 

= 

5.37123 

cyd3 

= 

- .452300e 

-03 

cld4  = 

.4552316-04 

cnd4 

= 

.  443923e -05 

cy  d4 

= 

-. 13 1700e 

-04 

cld5  = 

. 6752 1 7e -03 

cnd5 

= 

. 2 1 4483e -05 

cy  d5 

= 

0. 

cld6  = 

. 346200e -04 

cnd6 

= 

- .535563e -06 

cyd6 

= 

0. 

cld7  = 

- . 346 190e -04 

end? 

= 

. 535566e -06 

cy  d7 

= 

0. 

cld8  = 

0. 

end  3 

= 

0  . 

cy  d3 

= 

0. 

cld9  * 

0. 

cndS 

= 

0  . 

cyd9 

= 

0. 

lat-dir  stab  axis 

d imens ional 

der ivat  ives(  1/rad > 

nb  = 

9.09807 

lb 

= 

-49.8592 

yb  = 

-655.838 

np  = 

. 663333e -02 

1  P 

= 

-6.21357 

yp  = 

0. 

nr  = 

-2.  171  16 

1  r 

= 

1 .06103 

yr  = 

0. 

nd  1  = 

-3.51035 

1  d  1 

= 

2.32771 

yd  1  = 

29.654  1 

nd2  = 

.402357 

1  d2 

= 

-43. 1459 

y  d2  = 

14.4771 

nd3  = 

51719.6 

1  d3 

= 

-1256.73 

yd3  = 

-17.9333 

n  d  4  = 

. 427450e -0 1 

1  d4 

= 

3.43353 

y  d  4  = 

-.720426 

n  d  5  = 

. 206524a -01 

1  d5 

= 

51 .7531 

yd5  = 

0. 

162 


<s  <s 


B.4  LONGITUDINAL  ANO  LATERAL  DATA:  f-WCH  2.0  AT  40,000  FEET 


***************************************************** 
aircraft  parameters 

q  (dynamic  pressure  -  lbs/ft**2)  =  1104.44 

s  (uing  reference  area  -  ft**2)  =  603.000 

c  Cuing  mean  aerodynamic  cord  -  ft)  =  15.9400 

b  Cuing  span  -  ft)  =  42.7000 

vt  (trim  velocity  -  ft/sec)  =  1942.00 

theta  =  . 151500 

u  Cueight  -  lbs)  =  37794.2 

ixx  (slug -f t  **2 )  =  25633.0 

iyy  C  s 1 ug -f t  **2 )  =  185287. 

izz  C  s 1 ug -f t  **2  )  =  206359. 

ixz  C  slug-ft**2)  =  -2543.00 

**************************************************** 
alpha  =  . 151500 

longitudinal  non -dim  body  axis  coefficientsC 1/deg) 
cza  =  -.499000e-01  cma  =  -.745840e-02  cxa 

- . 973700e -04 


CZq  =  0. 

cmq  5 

=  -.654300 

CXq  = 

0. 

czh  =  - . 7357 10e -03 

cmh  = 

-.1183606-02 

exh  = 

903860e -03 

czu  =  . 204 1 10e -0 1 

emu  = 

=  - . 328360e -0 1 

exu  = 

-2.50760 

czd 1  *  - . 125090e -02 

.5854406-04 

cmd  1  = 

=  . 2 1 42 10e -02 

cxd  1  = 

czd2  *  - . 404930e -02 

cmd2  *  -6.38570 

cxd2  = 

. 464650e -03 

czd3  =  -.1  1 3090e -02 

.231340e-05 

cmd  3  = 

=  - . 254300e -02 

c  x  d  3  = 

czd4  =  -.1 1 3090e -02 

. 23  1 340e -05 

cmd4  ■ 

=  - . 254300e -02 

cxd4  = 

czd5  -  0. 

c  md  5 

=  0. 

cxd5  = 

0. 

czd6  =  0 . 

cmd  6 

=  0. 

cxd6  = 

0. 

c  zd  7  =  0 . 

cmd  7 

=  0. 

cxd7  = 

0. 

czd3  =  0 . 

cmd  3  = 

=  0. 

cxd3  = 

0. 

**************************************************** 

longitudinal  axis  dimens 

ional  derivatives 

body  axis  C  1/rad ) 

z a  -  -  1635 . 69 

ma  = 

-24.6364 

x  a  = 

-3. 19172 

zq  =  0 . 

mq  = 

-8 . 33737 

xq  = 

0. 

zh  =  - . 2 16738e -03 

mh  = 

- .  352083e -04 

xh  = 

266274e -03 

zu  =  . 120260e -0 1 

mu  = 

-. 1 95353e -02 

xu  = 

-  1  .47746 

zd  1  =  -4  1.0036 

md  1  = 

7.09009 

xd  1  = 

-1 .91903 

zd2  =  -132.733 

md2  = 

-21135.9 

xd2  = 

-15.2309 

zd3  =  -37.0701 

md3  = 

-8.41701 

xd3  = 

■ . 7533 1 Se -0 1 

zd4  =  -37.0701 

md  4  = 

-8.41701 

xd4  = 

164 


7583 16e 

-01 

zd5  * 

0. 

md5  = 

0. 

x  d  5  = 

0. 

zd6  = 

0. 

md6  = 

0. 

xd6  = 

0. 

zd7  = 

0. 

md7  = 

0. 

x  d  7  = 

0. 

zdS  = 

0. 

md8  = 

0. 

x  d  8  = 

0. 

**************************************************** 

longitudnal  state  matrix<body  ax  is > 

for  state l=u ,state2=q,state3=alpha,state4=theta 

-1.47746  -5 . 1 3433  -3.13172  -32.1939 

- . 195353e -02  -8.88737  -24.6864  0. 

. 6 19260e -05  .999397  -.342269  -.438426e-04 

0.  1.00000  0.  0. 


longitudnal  input  matrix 

for  de 1  1 =c anar d ,de 1 2=s t ab ,de 1 3=t ef  ,de 1 4=dr  aileron 
del5=rt  rv  ,  del6=rb  rv,  del7=lt  rv,  de!8=lb  rv 


row  1 


r  ou2 


r  ow3 


r  ou4 


-1 .91903 
-15.2309 
- . 7583 16e -0 1 
- . 7583 16e -0 1 
0. 

0. 

0. 

0. 


7.09009 

-21135.9 

-8.41701 

-8.41701 

0. 

0. 

0. 

0  . 


-  . 2  1  1  14  le  -0  1  0. 

- . 683487e -0 1  0. 

- . 190336e -0 1  0. 

-. 1 30886e -0 1  0. 

0.  0. 

0.  0. 

0.  0. 

0.  0. 


longitudinal  axis  dimensional  derivatives 


stab  i  1  ity 

axis  (  1 /r a  d ) 

za  = 

-1635.74 

ma  = 

-24 . 6762 

x  a 

= 

698505e 

-0  1 

zq  = 

0. 

rnq  = 

-3.38787 

xq 

= 

0. 

zh  = 

- . 247006e -03 

mh  = 

- . 358 1 39e -04 

xh 

= 

266268e 

-03 

zu  = 

. 1 37055e -0 1 

mu  = 

-. 1 937 1 4e -02 

XU 

= 

-1.47743 

zd  1  = 

-40.9984 

md  l  = 

7.09009 

xd  1 

= 

-2.02744 

zd2  = 

-132.692 

md  2  = 

-21 135.9 

xd2 

= 

-15.5818 

zd3  = 

-37.0698 

md3  = 

-8.41701 

xd3 

= 

-. 173851 

zd4  = 

-37.0693 

md4  = 

-8.41701 

xd4 

= 

-. 173851 

zd5  = 

0. 

md5  = 

0  . 

xd5 

= 

0. 

zdS  = 

0. 

md6  = 

0. 

xd6 

= 

0. 

************************** 
lat-dir  body  axis  coeffic 


******************* 

ients 


clb  = 

. 1 44930e 

- . 7605S0e -03 

-01 

cnb 

= 

. 162300e -03 

cy  b 

= 

C  1  P  = 

- . 555 1 30e -02 

cnp 

= 

- . 249 150e -05 

cyp 

= 

0. 

c  1  r  = 

. 675400e -03 

cnr 

= 

- . 375400e -0 1 

cy  r 

= 

0. 

cld  1  = 

4383  10e  - 

. 3396 10e -04 

03 

end  1 

= 

-.275500e-03 

cyd  1 

= 

cld2  = 

829290e - 

- . 4343 1 0e -03 

03 

c  nd  2 

= 

. 158240e -03 

cy  d2 

= 

cld3  = 

. 460600e -03 

cnd3 

. 247690e -04 

cy  d3 

= 

-2.93180 

cld4  = 

. 770730e 

. 104500e -03 

-04 

cnd4 

= 

. 562860e -05 

cyd4 

= 

cld5  = 

. 67 1 730e -03 

cnd5 

= 

0. 

cy  d5 

0. 

c  1  d6  = 

. 376750e -04 

cnd6 

= 

0. 

cy  d6 

= 

0. 

cld7  = 

- . 376750e -04 

cnd7 

= 

0  . 

cy  d7 

= 

0. 

c  1  d3  = 

0. 

cnd8 

- 

0. 

cyd8 

= 

0. 

cld9  = 

0. 

cnd9 

= 

0. 

cyd9 

= 

0. 

************************** 
lat-dir  stab  axis  c 


************************** 

oe-f-f  ic  ients 


clb  = 

- . 760 1 48e -03 

cnb 

= 

. 16431 le -03 

cy  b 

= 

. 144930e 

-01 

c  1  p  = 

- . 555024e -02 

cnp 

= 

- . 870782e -04 

cyp 

= 

0. 

c  1  r  = 

. 5903 1 3e -03 

cnr 

= 

- . 3754 16e -01 

cyr 

= 

0. 

cldl  = 

. 332324e -04 

end  1 

= 

- . 275589e -03 

cyd  1 

= 

4933 10e  - 

03 

cld2  = 

- . 433890e -03 

cnd2 

= 

. 1 59388e -03 

cy  d2 

= 

829290e - 

03 

c  1  d  3  = 

. 460664e -03 

cnd3 

5 

.2355 10e -04 

cyd3 

= 

-2.93180 

c  1  d  4  = 

. 1045 15e -03 

cnd4 

= 

. 535226e -05 

cy  d4 

= 

. 770730e 

-04 

cld5  = 

. 67 1 728e -03 

cnd5 

= 

-. 1 776 1 7e -05 

cy  d5 

= 

0. 

cld6  = 

. 376749e -04 

cnd6 

= 

- . 996 1 9 1 e -07 

cy  d6 

= 

0. 

cld7  = 

- . 376749e -04 

c  nd  7 

= 

. 996 19 le -07 

cyd7 

= 

0. 

c  1  d8  = 

0. 

ends 

= 

0. 

cyd8 

= 

0. 

c  1  d9  = 

0. 

cndS 

= 

0  . 

cydS 

= 

0. 

:-dir  stab  axis  dimensional  der  ioat  iues(  l/'rad  ) 


nb 

= 

1 .30819 

1  b 

= 

-43 .1185 

yb 

= 

-475.070 

np 

= 

- . 762 1 87e -02 

1  P 

= 

-3.36255 

yp 

= 

0. 

nr 

= 

-3.28593 

lr 

= 

.411162 

y  r 

= 

0. 

nd  1 

= 

-2. 19415 

1  d  1 

= 

2 . 10366 

yd  1 

= 

16 . 3343 

nd2 

1 .26899 

1  d2 

= 

-27.4653 

yd2 

= 

27. 1835 

nd3 

= 

. 137505 

1  d  3 

= 

29 . 1607 

y  d3 

= 

-96 102 . 3 

nd4 

= 

. 425 1 29e -0 1 

1  d4 

6.61592 

y  d4 

= 

-2.52640 

nd5 

= 

- . 14 14 13e -01 

ld5 

= 

42.5213 

y  d5 

= 

0. 

nd6 

= 

- . 793 134e -03 

1  d6 

= 

2.38487 

yd6 

= 

0  . 

nd7 

. 793 134e -03 

Id? 

= 

-2 . 33487 

y  d7 

= 

0. 

nd8 

= 

0. 

1  d8 

= 

0. 

yd3 

= 

0. 

tm 


nd9 

= 

0. 

1  d9 

= 

0. 

yd9 

= 

0. 

**************************************************** 

1  at 

-d ir  body  ax  is 

d imens ional 

der iuat  iues< 

1/r ad ) 

nb 

= 

1.29209 

lb 

3= 

-48. 1731 

yb 

= 

-475.070 

np 

= 

-  .  2 18063e -03 

1  P 

= 

-3.86583 

yp 

= 

0. 

nr 

= 

-3.28561 

lr 

= 

.470284 

yr 

= 

0. 

nd  1 

= 

-2 . 19328 

1  d  1 

= 

2. 15100 

yd  1 

= 

16.3343 

nd2 

= 

1 . 25876 

1  d  2 

= 

-27.5080 

yd£ 

= 

27. 1835 

nd3 

= 

.  197138 

1  d  3 

= 

29. 1732 

yd3 

= 

-96102.3 

nd4 

= 

. 443098e -0 1 

1  d4 

= 

6.61875 

y  d4 

= 

-2.52640 

nd5 

= 

0. 

1  d5 

= 

42.5456 

yd5 

= 

0. 

nd6 

= 

0. 

ld6 

= 

2.38623 

yd6 

= 

0. 

nd7 

= 

0. 

1  d7 

= 

-2.38623 

yd7 

= 

0. 

nd8 

= 

0. 

1  d8 

= 

0. 

yd8 

= 

0. 

nd9 

= 

0. 

1  d8 

= 

0. 

yd9 

= 

0. 

:*************  ************************************** 
lateral  directional  state  matrix 
states  =  ph  i  ,beta  ,p  ,r  ,ps  i 


0.  0.  1.000  0.  0. 

. 1653e -0 1  -.2446  . 2644e -02  -1.000 

4384e -04 

0.  -48.36  -3.870  .7934  0. 

0.  1.883  . 4748e -0 1  -3.295  0. 

0.  0.  0.  1.000  0. 


lateral  directional  input  matrix 

•for  inputs:  de  1  1  =rudder  ,de  1 2=d  i-f  f  can 
de!3=d  i-f-f  stab,  del4=diff  ail,  del5=diff  tef 


de 1 6  to 

9  are  reuerser  vane 

ports 

rou  1 

r  ou2 

r  ow3 

rou4 

r  o 

0. 

.34 1 le -02 

-2.222 

2.369 

0. 

0. 

.  1 400e -0  1 

1.601 

-27.66 

0. 

0. 

-49 . 48 

-.  1625 

29.  19 

0. 

0. 

-  .  130 le -02 

- . 3630e -01 

6.622 

0. 

0  . 

'  0  . 

-.5248 

42.60 

0  . 

0. 

0. 

-  .  2344e -0 1 

2.389 

0. 

0. 

0. 

.  2344e -01 

-2.389 

0. 

Appendix  C:  0DEF15 


In  order  to  analyze  the  CGT/PI/KF  controller 
designs  used  in  the  course  of  this  thesis,  0DEF15  was 
written.  0DEF15  is  written  in  FORTRAN  V  and  is  hosted  on 
the  CDC  Cyber  mainframe  computer.  It  is  derived  from 
expanding  an  analysis  package  known  as  ODEACT  written  by 
Maj  W.  Miller  (16) .  The  software  is  completely  inter¬ 
active,  providing  the  user  with  prompts  for  each  input. 
Also,  a  file  structure  is  available  which  allows  the  user 
both  to  read  and  to  write  data  to  local  files.  The  code 
is  specific  to  the  STOL  F-15  only  in  the  actuator  dynamics 
and  rate/position  limits,  which  are  "hardwired"  into  the 
software.  However,  by  eliminating  the  entries  of  the 
actuator  dynamics  and  saturation  limits  from  the  external 
subroutine  FSTOL ,  any  CGT/PI/KF-controlled  system  could  be 
analyzed.  Files  can  be  formed  for  Kalman  filter-based 
systems  as  well  as  full  state  feedback  systems.  The  user 
must  declare  the  library  routines  IMSL  and  Ode  (Inter¬ 
national  Mathematical  and  Statistical  Library,  and  Ordinary 
Differential  Equations  solver)  before  running  0DEF15  as 
these  libraries  are  referenced  in  the  main  program.  For 
the  Kalman  filter-based  systems,  the  user  is  asked  how  many 
iterations  are  desired  for  the  Monte  Carlo  analysis.  It 
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is  advised  that  the  user  limit  the  number  of  iterations  to 
7  or  less  to  avoid  long  computational  times  (10  run  averages 
can  take  in  excess  of  10  minutes) . 

After  data  has  been  entered  and  the  analysis  has 
been  performed,  the  user  is  provided  with  a  menu  to  choose 
output  data  to  be  plotted  to  the  terminal  using  the  PLOTLP 
plotting  routine  from  Reference  7.  Finally,  plot  files 
are  created  and  written  to  user-specified  output  files. 

These  plot  files  can  be  routed  to  the  CALCOMP  plotter  using 
the  PLOTM  routine  available  through  the  Super  Procfile  avail¬ 
able  on  the  NOS  operating  system  (2). 
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PROGRAM  0DEF15 


C**********************************-*  ♦  :*: ♦: :*: :*: *' :#: .*: i. .+.  t  :*  *: :*: :*: :#c  *: :*: :*: :*: :*. :*; :*: *: :*  :*  t  *  :*:  *  t  :*: 
C 

C  SIMULATION  PROGRAM  TO  TEST  A  PI  OR  CGT/F'I,  WITH/WITHOUT  KALMAN 
C  FILTER,  BASED  ON  A  4-STATE  MODEL  OF  THE  STQL  F-15.  OPTIONS 
C  INCLUDE  MODIFICATION  OF  DYNAMICS  MATRIX,  USE  OF  2-STATE 
C  ACTUATOR  MODELS,  APPLICATION  OF  RATE/POS I T I ON  LIMITS  ON  ACTUATORS, 

C  AND  EMPLOYMENT  OF  ANT I -WINDUP  COMPENSATION.  USER  SUPPLIES  DYNAMICS 
C  MATRIX,  OUTPUT  MATRIX,  CGT  COMMAND  MODEL,  CONTROLLER  GAINS  AND 
C  KALMAN  FILTER  MATRICES. 

C 

C  DATE  OF  LAST  REVISION:  01  NOV  S5 
C  LIBRARIES  USED:  ODE, IMSL5 
C 

C*:*:***#***.1:.|::*:^***:^***^*****-4:*.1t*:<c.ic**:*:****-*^^*:tc:«:*:lc4:^:ic*l:**.l:*****:*::*::*:*:*:*.-4::*;:*: 

C 

REAL  WORK (352) , X  Cl 2) , DX  (12) , OUT C 51 , 4) , T, TOUT, TS AMP, PLTVECC260) 
REAL  X TEMP (12) 

REAL  AW0RKC4,  4)  ,  BWORK  (4,4)  ,  CW0RK(4,4)  ,  AM <4,  4) ,  BM(4,  4) ,  Z  (3) 

REAL  I  PH  I X  ( 4 , 4  :> 

REAL  RELERR, ABSERR, DSIM, 0UT1 (51 , 5) , U0UT2 (51 , 4) , U0UT3C51 , 5) ,  Y(4) 
REAL  VC3> , EVTMPC2) 

INTEGER  NR, MMM, JJJ 
DOUBLE  PRECISION  DSEED 

INTEGER  I, J,K,  I  FLAG, JFLAG, JCFLAG, NFL AG, I WORK C5> , I DSIM 
INTEGER  MMFLAG, 1 1 FLAG 

COMMON /MATR I X/UO (2  > , A ( 12, 12 ) , C (4, 12) , KX (4,  12  > ,  K  Z  C  4 , 4 )  ,  K  X  M  C  4 ,4), 

1  KXU  < 1,4) , PHI <4, 4) , PH TNT (4,4) , CM (4, 4) , BCG, 3) , EV<2) , KFLAG, MM 
COMMON /CONTRL/'JNEW  ( 4 )  ,UQLDC4)  ,UCMDC4)  ,  UCGLD  ( 4 )  ,  X0LDC12)  , 

1  XM0LDC4) , X  M ( 4 ) , MFLAG, EVA f 2 ) , 

1  H  ( 3 ,  4 ) ,  PH  I X  (  4 , 4  >  ,  BD  (4,3),  QD  (4,4)  ,  R  ( 3 , 3 )  ,  /HP  (>♦)  ,  XHM<  4 ')  ,  KC4, 3) 
EXTERNAL  FI , F3, F4 , FSTOL 

CHARACTER  ANSW41 ,  TITLE450,  DATA46,  S AVER'S,  PLGT4E 
C 
C 

C 

C  INPUT  SECTION.  DATA  MAY  BE  READ  IN  FROM  AN  ’ OLD*  FILE,  AND  SAVED 
TO  ANY  OTHER  FILE.  ONLY  ONE  SET  OF  DATA  PER  FILE  NAME.  PLOTS  APE 
AUTOMATICALLY  SAVED  IN  A  ?  PLOT  FILE7. 

C 

20  PR I NT 4, ’  INCORPORATE  KALMAN  FILTER?  Y/N:  f 

READ  C  4,  »  (A)  '  )  ANSW 

IF  (ANSW. NE. ’Y' .AND. ANSW. NE. ’N’ >  GO  TO  20 
IF  (ANSW. EO. ' Y'  <  1 1 FLAG= 1 
IF  (ANSW. EO. ’ Nf )  I  I FLA6=0 
302  PRINT*, ' DATA  TO  BE  READ  FROM  FILE?  Y/N:  » 

READ ( 4, ’ (A) ' )  ANSW 

IF (ANSW. NE. 'Y' .AND. ANSW. NE. »N» )  GO  TO  S02 
IF ( ANSW . EO . ’ N T  '  GO  TO  30 
JCFLAG=0 
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PRINT#, 'ENTER  NAME  OF  DATA  FILE:  ' 

READC*, '  CA> '  )  DATA 

OFEN < 2 , F I LE=DATA , STATUS= ' OLD ' , FORM= ’ UNFORMATTED ' , ERR -902 ) 
READ  C2>  C  CA< I , J) , 1  =  1 , 12) , J=1 , 12  » 

'  READ (2) <  CBC I, J) , 1  =  1,3) , J=l,3) 

READ (2) C (CCI, J) , 1=1,4), J=l, 12) 

READ ( 2 ) C ( K X  < I , J ) , I  =  1 , 4 ) , J  = 1 , 12) 

READ (2) ( CKZC I, J) , 1=1,4) , J=l,4) 

READ (2) CCKXUCI, J), 1=1 , 4) , J=1 , 4) 

READ (2) C CKXMCI, J) , 1=1,4) , J=l,4) 

READ (2) C  CAMCI, J) , 1  =  1 , 4) , J=1 , 4) 

READ  C  2  )  <:  C  BN  (  I ,  J )  ,  I  =  1 , 4 ) ,  J=  1 , 4 ) 

READ (2) C  CCM< I , J) , 1  =  1 , 4)  ,  J=1 ,4) 

IF (I IFLAG.EQ.O)  00  TO  901 

READ (2)  CCPHIXCI,J),  1  =  1,4)  ,J=1, 4) 

READ < 2) <  CBDCI , J) , 1  =  1 , 4) , J=1 ,3) 

READ C 2) ( COD (I, J) , 1=1 ,4) , J=1 , 4) 

READ (2) C 

<HCI, J), 1=1,3), J=l, 4) 

READ  C2) C(K(I, J), 1  =  1 , 4) , J=1 , 3) 

READ  (2)  <  CRC  I ,  J.» ,  1  =  1 , 3) ,  J=1 , 3) 

901  CONTINUE 

REWIND  02) 

CLOSE C 2) 

GO  TO  140 

FOR  KEYBOARD  INPUT,  ONLY  NON-ZERO  MATRIX  ELEMENTS  ARE  REQUIRED. 
NO  NON-ZERO  ENTRIES  SHOULD  BE  MADE  FOR  COLUMNS  5,6,7,9,10  OR  11 
OF  A  OR  KX,  BUT  NO  PROTECTION  PROVIDED  AGAINST  DOING  SO. 

30  DO  50  1=1,12 

DO  50  J=1 ,  12 
A  < I , J ) =0 . 0 
50  CONTINUE 

DO  42  1=1,3 
DO  42  J=1 ,3 

RC I, J) =0 . O 
BCI, J) =0.0 
42  CONTINUE 

DO  64  1  =  1 ,  12 
DO  60  J=1 , 4 
KXCJ,  I)=0.0 
60  CONTINUE 

DO  64  L=1 ,4 
CCL, I) =0.0 
64  CONTINUE 

DO  66  1=1,4 
DO  66  J= 1,4 

PH I X ( I , J ) =0 . 0 
KZC I, J)=0.0 
KXU  < I , J) =0. 0 
KXM C I , J ) =0 . 0 
66  CONTINUE 

DO  70  1=1,4 

DO  70  J=1 , 4 

AM  Cl , J ) =0  ' 


<* 
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BMC  I, J)=0 
CMC  I f  J) =0 
QDCI, J) =0 . 0 

70  C 

DO  903  1=1,4 
DO  903  J=  1 , 3 
HCJ, I) =0.0 

k  c  i ,  j  :>  =o .  o 

BD  C I , J ) =0 . 0 

903  CONT I NUE 
JFLAG=0 

72  PRINT*, ’ ENTER  DYNAMICS  MATRIX:  ’ 

CALL  EDIT C A, 12, 12) 

IFCJFLAG.NE.O)  GO  TO  140 
74  PRINT*:,  ’ENTER  CONTROL  MATRIX:  ’ 

CALL  EDITCB,  3, 3.) 

IFCJFLAG.NE.O)  GO  TO  140 
76  PRINT:*, ’ENTER  OUTPUT  MATRIX:  ’ 

CALL  EDITCC,4, 12) 

IFC JFLAG.NE.O)  GO  TO  140 
78  PRINT:*:, ’ENTER  KX  MATRIX:  ' 

CALL  EDITCKX, 4, 12) 

IFCJFLAG.NE.O)  GO  TO  140 
00  PRINT*:,  ’  ENTER  KZ  MATRIX:  » 

CALL  EDIT CKZ, 4,4) 

IFCJFLAG.NE.O)  GO  TO  140 
82  PRINT:*,  ’  ENTER  KXM  MATRIX;  ’ 

CALL  EDIT  CKXM, 4,4) 

IFCJFLAG.NE.O)  GO  TO  140 
84  PRINT:*, ’ENTER  KXU  MATRIX:  ’ 

CALL  ED  IT(. KXU,  4, 4) 

IFCJFLAG.NE.O)  GO  TO  140 
86  PRINT:*, ’ENTER  MODEL  DYNAMICS  MATRIX:  ’ 
JCFLAG=0 

CALL  EDIT  CAM, 4, 4) 

IFCJFLAG.NE.O)  GO  TO  140 
88  PRINT:*,  ’ENTER  MODEL  CONTROL  MATRIX:  ’ 

JCFLAG=0 

CALL  EDIT  CBM, 4, 4) 

IFCJFLAG.NE.O)  GO  TO  140 
90  PRINT*, ’ENTER  MODEL  OUTPUT  MATRIX:  ' 

CALL  EDIT  CCM, 4,4) 

IFCJFLAG.NE.O)  GO  TO  140 
IF  C 1 1 FLAG. EQ. 0)  GO  TO  140 

904  PRINT:*, ’ENTER  STATE  TRANSITION  MATRIX:’ 

CALL  EDIT  C F*H I  X ,  4 , 4 ) 

IFCJFLAG.NE.O)  GO  TO  140 

905  PRINT:*, ’ENTER  DISCRETE  TIME  INPUT  MATRIX’ 

CALL  EDIT  CBD, 4,3) 

IFCJFLAG.NE.O)  GO  TO  140 

906  PRINT*, ’ENTER  DISCRETE  TIME  COVARIANCE  MATRIX 
CALL  EDIT  CCD, 4,4) 

IFCJFLAG.NE.O)  GO  TO  1.40 

907  PRINT:*,  '  ENTER  MEASUREMENT  MATRIX:' 

CALL  EDIT (H, 2, 4)  172 
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IFCJFLAG.NE.O)  GO  TO  140 
908  PRINTS, ’ENTER  KALMAN  FILTER  GAINS:' 

CALL  EDIT  CK,  4,3) 

IFCJFLAG.NE.O)  GO  TO  140 

909  PRINTS, ' ENTER  MEASUREMENT  NOISE  COV.  MATRIX' 

CALL  EDIT  CR, 3, 3) 

IFCJFLAG.NE.O)  GO  TO  140 
140  PRINT:*,  ’ANY  CHANGES  TO  MATRICES?  Y/N:  ' 

READ  C  :*: ,  '  C  A )  '  )  ANSW 

IF C  ANSW . NE .  ’ Y'  . AND . ANSW. NE.  ' N' )  GO  TO  140 
142  IFCANSW.EQ. ' Y' )  THEN 

PRINT*, ’1=A  2=C  3=KX  4=KZ  5=KXM  6=KXU' 

PRINT:*:,  '  7= AM  B=BM  9=CM  10=B  ' 

PRINT*,  '  U=PHIX  12=BD  13=0D  14=H  15=K  16=R' 

PRINT*,'  ENTER  CHOICE:' 

READ*, JFLAG 

GO  TO  c.  72 ,  76,  78 , 80 ,  82 , 84 , 86 ,  8B,  90 ,  74 , 904 ,  905 , 

1  906 , 907 , 908 , 909 )  JFLAG 
ELSE 

JFLAG=0 
END  IF 

150  PRINT*, 'WRITE  DATA  TO  OUTPUT  FILE?  Y/N:  ' 

READ ( * , ' CA) ' ) ANSW 

IF C ANSW. NE. 'Y' .AND. ANSW. NE. 'N' )  GO  TO  150 
IFCANSW.EQ.' Y' )  THEN 

PRINT*, 'ENTER  NAME  OF  OUTPUT  FILE:  ' 

READ  C* , '  CA) ' >  SAVE 

OPEN  C  3 , F I LE=S A VE , FQRM= ' UNFORMATTED ' , ERR=80 ) 

WRITEC3) C CACI, J) , 1=1, 12),J=1,12) 

WRITEC3) CCBCI, J), 1=1 , 3) , J=1 , 3) 

WRITE  C3 ) CCCCI, J), 1=1,4), J=l,  12) 

WRITE C3) C  CKX  C I , J) , 1  =  1,4) , J=1 , 12) 

WR I TE  C  3 ) C  C KZ  C I , J ) , 1  =  1,4) , J= 1 , 4 ) 

UR  I  TEC  3) C  CKXUC I,J),I  =  1,4),J=1,4) 

WRITEC3) CCKXMCI, J), I =1 , 4) , J=1 , 4) 

WRITEC3) C  CAMC I , J) ,  1  =  1,4) , J= 1 ,4) 

WRITEC3) CCBMCI, J), 1=1 , 4) , J=1 , 4) 

WRITEC 3) C  CCMC I, J) , 1  =  1,4) , J=l,4) 

IF  C 1 1  FLAG . EQ . 0 )  GO  TO  910 

WRITE C3) CCPHIXCI, J), 1=1 , 4) , J=1 , 4) 

WRITEC3) ( CBDC I , J) , 1=1 ,4) , J= 1 ,3) 

WRITEC3) C  CQDC I , J) , 1  =  1,4) , J=l,4) 

WRITE C3) <  CHC I, J) , 1  =  1,3), J=l,4) 

WR I TE  C  3 ) CCKCI, J), 1  =  1 , 4) , J=1 , 3) 

WRITEC3) C  CR( I , J ) ,  1  =  1 , 3) , J=1 , 3) 

910  CONTINUE 

ENDFILE  (.  3) 

REWINDC3) 

CLOSE  C  3 ) 

END  IF 
C 

C*  *  *  *  *  *  *  *  *****  *  *  *  *  *  .*:  *  **:*:*:*  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  :*:  *  *  *  *  *  *  *  *  :*:  *  *  *  :*:  *  *  *  *  *.*::*: 

NOW  SET  UP  CONDITIONS  FOR  CALLING  ODE.  ALL  INITIAL  CONDITIONS 
ARE  ZERO  UNLESS  CHANGED  BY  USER  INPUT. 
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C*****  *  ***  *  *  *  *  *  XX  X  X  X  X  X  XX  X  X  X  X  X  X  X  X  X  X  X  X  XXX  X  X  X  X  XXXX  X  X  X  X  X  X-  X  X  X  X  X  X  X  X  X  X  X  X  X  X  X  X  t 

c 

IFC JCFLA6.  EQ.  0)  THEN 

PRINT*, ’ENTER  SAMPLING  TIME:  * 

READ*, TSAMP 

CALL  DSCRT C AM , 4 , TSAMP , PH I , PH I NT , 30 , AWORK , B WORK , C WORK ) 

CALL  MATML C PHI NT , BM, AWORK, 4, 4, 4) 

CALL  COPYMT  (.AWORK,  PH  I  NT,  4,4) 

PRINT*, ’ 

JCFLAG= 1 
END  IF 

PRINT*, 'ENTER  CANARD  TRIM  ANGLE  OF  ATTACK’ 

READ*, EV Cl) 

PRINT*, ’ENTER  STABILATOP  TRIM  ANGLE  OF  ATTACK  IN  RADIANS  ’ 

READ*,  EV 02) 

EVTMPC 1 )=EVC 1 ) 

E VTMP  C  2 ) =EV  C  2 ) 

154  PRINT*,’  PATE/FOSITION  LIMITS?  Y/N:  ’ 

READ  C*, ' CA) ’ > ANSW 

IFCANSW.NE. ’ Y’ . AND. ANSW.NE. ’N’ )  GO  TO  154 
IFCANSW. EQ. ’ Y’ )  MFLAG=1 
IF  CANSW. EQ. ’ N’ )  MFLAG=0 
156  PRINT*,’  ANTI-WINDUP  COMPENSATION?  Y/N:  ’ 

READ  C  * , ’  CA) ’  ) ANSW 

IFCANSW.NE. ’Y’ .AND. ANSW.NE. ’N' )  GO  TO  156 
IFCANSW. EQ. ’ Y’ >  NFL AG= 1 
IFCANSW. EQ. ’N’ )  NFLAG=0 

222  PRINT*, ’ EMPLOY  ACTUATOR  DYNAMICS?  Y/N:  ’ 

READ  C*, ’  CA) ’ ) ANSW 

IFCANSW.NE. *Y’ .AND. ANSW.NE. ’N’ )G0  TO  222 
IFCANSW. EQ. ' Y’ )MM=0 
IF CANSW. EQ. ’N’ )MM=1 

155  PRINT*, ’ENTER  DESIRED  RESFONSE  DURATION:  ’ 

READ*, DSIM 

IFCDSIM.LT. 0.1)  GO  TO  158 
I DS I M= I NT  C  DS I M / C  50 . 0*TSAMP )  + . 99 ) 

160  DO  170  1=1,12 
X  C I ) =0 . 0 
XOLD  Cl) =0.0 
170  CONTINUE 

EVA  Cl)  =0 .  0 
EVA C2) =0.0 
DO  172  1=1,4 
UOLDC I ) =0. 0 
YC I )=0. O 
XHP  Cl) =0. 0 
XHMC I ) =0 . 0 

UNEWC I ) =0. 0 
172  CONTINUE 

DO  175  1=1,4 
UCMDC I) =0.0 
UCOLDc I)=0. 0 
XMC I ) =0. 0 
XMOLDC I) =0.0 
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Y  C  I >=0. 0 
175  CONTINUE 

180  PRINT*, ’ENTER  I  AND  X(I>;  0,0  TO  TERMINATE:  ’ 

190  READ*, III I,EL 

IFCIIII.LE. 12. AND. II II. GE. 1)  THEN 
X  ( 1 1 1 1 ) =EL 
GO  TO  190 

ELSE  IFCIIII.EQ.O)  THEN 
GO  TO  200 
ELSE 

PRINT*, ’SUBSCRIPT  OUT  OF  RANGE' 

GO  TO  ISO 
END  IF 

200  PRINT*,’  SELECT  COMMAND  INPUT  S<  STEP  MAGNITUDE:’ 
READ*, IK, ELL 

IF  C IK.  LE.  3. AND. IK. GE. 1 ) THEN 

UCMD  <:  IK  )  =ELL 

ELSE 

PRINT*, '  SUBSCRIPT  OUT  OF  RANGE’ 

GO  TO  200 
END  IF 
T =0.  O 
T0UT=0. 0 
IFLAG=-1 
RELERR=1 . E-08 
ABSERR= 1 . E-07 
UO Cl) =0.0 
UO  C  2 ) =0 . 0 

IF  C 1 1 FLAG. ED. 1 > THEN 

PRINT*, ’ENTER  SOURCE  OF  OUTPUT  MEASUREMENTS’ 
PRINT*,  ’  1 --SYSTEM  STATES  2=0UTPUT  VARIABLES’ 
READ*, NN 
IF  CNN.  EC!.  1  >  THEN 

13  PRINT*, ’ ENTER  STATES  TO  BE  MEASURED  C3)’ 

READ*, L, M, N 

IFC CL.GT. 12) .OR. CL.LT. 1) )  GO  TO  913 
IFCCM.GT. 12). OR. CM.LT. 1))  GO  TO  913 
IFCCN.GT. 12). OR .CM.LT.l))  GO  TO  913 
ELSE 

14  PRINT*, ’ENTER  OUTPUT  VARIABLES  TO  BE  MEASURED  C3) 
READ*,  L, M, N 

IFC  (L.GT.3)  .OR.  CL.L.T.  1)  )  GO  TO  914 
IFCCM.GT. 3). OP. CM.LT.l))  GO  TO  914 
IFC CN.GT.3) .OR. CN.LT. 1) )  GO  TO  914 
END  IF 
END  IF 
X I TER=1 . 

I F  C 1 1 FL AG . ED . 0 )  GO  TO  920 

51  PRINT*, 'ENTER  #  OF  ITERATIONS  FOR  FILTER  AVERAGE' 
READ*, XI  TER 
NR=3 

PRINT*, ’SELECT  SEED  VALUE  FOR  RANDOM  #  GENERATION 
READ*, DSEED 

937  PRINT*, 'CONTROL  BASED  ON  XHAT  +  OR  XHAT-?’ 

PRINT*,  ’  XHATi-=l  XHAT-=2 ’ 


"O' 


READ* , JMFLAG 

IFC  (JMFLAG. GT . 2> . OR.  (JMFLAG. LT. l))GO 
920  CONTINUE 

DO  750  11=1,51 
OUT (II, 1 ) =0. 

OUT 1 (11,1 ) =0. 

U0UT2CI I, 1 >=0. 

U0UT3C II, 1 ) =0 . 

OUT (11,2) =0. 

OUT (II, 3) =0. 

OUT (11,4) =0. 

OUT 1(11,2) =0. 

OUT 1(11, 3) =0. 

OUT  1(11,4) =0 . 

OUT 1 (11,5) -0. 

U0UT2 (  1 1 , 2 ) =0 . 

U0UT2 (11,3) =0. 

U0UT2 (11,4) =0. 

U0UT3CII , 2 ) =0 . 

U0UT3C 1 1 , 3 '>=0 . 

U0UT3 (II, 4) =0. 

U0UT3 (11,5) =0 . 

750  CONTINUE 

IF ( 1 1 FLAG. EO. 0)  GO  TO  1040 

DO  780  I JK=1 , X  ITER 

T=0 . 0 

T0UT=0.0 

IFLAG=~ 1 

RELERR=  1 .  E-03 

ABSERR=1. E-07 

UO ( 1 >  =0 . 0 

UO ( 2 ) =0 . 0 

DO  1010  1=1,4 

XMC I ) =0. 0 

UOLD ( I > =0 . 0 

UNEW ( I ) =0. 0 

UCMD ( I ) =0 . 

UCOLDC I)=0. 

XMOLD  < I ) =0. 

Y  ( I ) =0 . 


XHP ( I ) =0. 

XHM( I ) =0. 

1010  CONTINUE 

DO  1020  1=1,12 
XTEMP ( I ) =0. 

XCI)=0. 

XOLD  (  I  :>=o. 

1020  .ONTINUE 

X ( 1 1 1 1 ) =EL 
UCMD ( I K ) =ELL 
EVA ( 1 ) -0 . 0 
EVA ( 2  J =0 . 0 
EV  ( 1 )  =EVTMF'  (  1 ) 

EV(2)=EVTMF'  (.2) 

1040  CONTINUE 
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TO  937 


DO  300  I=IDSIM+1 , 51YIDSIM+1 
CALL  ER  X SET  <  300 , 0  > 

CALL  MATMLCC, X,Y, 4, 12f 1) 

IF< IDS IM. NE . 1 . AND. MOD  C I ,  IDS IM) . EQ. 1 )  THEN 
J=INT ( I /IDSIM) 

OUT  (  J , 1)=T0UT+0UTCJ,  1) 

OUT  (.J ,  2)  =Y  (  1  :>+OUT(  J,  2) 

OUT  ( J,  3)=Yt2)  +QUT  (J,  3) 

OUT ( Jt  4) =Y (3) +OUT  t  J ,  4) 


OUT 1 ( J, 1 >=T0UT+0UT1 C  J , 1 J 
OUT  1 CJ, 2)=UNEWC 1 ) +0UT1 C J, 2) 
OUT 1  <  J ,  3 ) =UNEW  C 2 ) +OUT 1 C  J , 3 ) 
OUT  1  <  Jf  4  )  =UNEW  ( 3)  +OUT 1  (J,  4) 
OUT  1  ( J,  5)  =UNEW (4)  +OUT 1  < J,  5) 


U0UT2C J, 1 ) =TOUT +U0UT2  (J, 1 ) 
U0UT2 ( J, 2) =X (5) +U0UT 2 C J ,  2) 
U0UT2 <  J , 3  > =  X  C  7 ) +U0UT2  C  J ,  3 ) 
U0UT2 ( J , 4)  =  X  03) +U0UT2 ( J ,  4) 


U0UT3 <  J ,  1  ) =TOUT +U0UT3 <  J , 1 ) 


U0UT3C  J,  2 :j  =  X  t:  I  )+U0UT3(J,  2) 
U0UT3  <  J, 3 ) =X  C  2 )  +U0UT3  <  J ,  3 ) 
U0UT3C  J,  4)  — X  <3)-MJ0UT3<  J,  4) 
U0UT3 <  J f  5 ) *X  <  4 ) +U0UT3 C  J , 5 ) 
ELSE  IF  t  IDSIM.  EQ.  1 )  THEN 
J=I-IDSIM 

OUT ( J , 1  )=TOUT+OUT<J, 1) 
OL'TCJ,  2)  =  Y (.  1 )+OUT< J,2) 
OUT  C J, 3)=Y (2) +OUT(J,  3) 
OUT ( Jf  4) =Y (3) +OUT (3,4) 


OUT  1  (.  J,  1  )=TOUT+OUTl  C  J,  1  > 

OUT  1  <  J ,  2 )  =UNELI  C 1  >  +0UT 1  C  J ,  2) 
0LIT1  <Jf  3)=UNEW<2)+0UT1  C  J ,  3 ) 
out i  <:j,  4:>=unew!:3>+outi  cj,  4) 
OUT 1 <  J , 5 ) =UNEW C 4 ) +OUT 1  C  J ,  5 ) 


U0UT2 ( J, 1 ) =TOUT +U0UT2  C J ,  1 ) 
U0UT2C J f2)=X(5> +UQUT2 ( J,  2) 
U0UT2  C.  J,  3)  =  X  ( 7 )  +UOUT 2  C  J,  3) 
U0UT2(  J f  4)  =X  03) +U0UT2 ( Jf  4) 


U0UT3  (  J,  l  )  =T0UT+U0UT3C  J,  1  j 
U0UT3<.  J ,  2)  =X  (.  1  )  +U0UT3  CJ,  2) 
UQUT3C J, 3) =X (2) +U0UT3 C J, 3) 
U0UT3C J , 4  ;  =X < 3) +U0UT3 ( J ,  4) 
U0UT3C  J,5  )=X  C 4)  +  U0UT3  c  J ,  5) 
END  IF 

TOUT=TOUT+TSAMP 
IF  < 1 1 FLAG . EQ .  1 i THEN 
CALL  GGNML < DSEED , NR , V ; 
V(1)=R(1(1)WU) 


VC2)=RC2,  2)*VC2) 

VC3)=RC3,3)*VC3) 

IF  CNN. EQ. 1 ) THEN 
Z  C 1 )  =  X  CL) +V ( 1 ) 

ZC2)=XCM)+VC2) 

ZC3)=X(N)+VC3) 

ELSE 

zcn=YCL)+vcn 
Z ( 2 ) =Y  CM) +  0  C2 ) 

ZC3)=YCN)+VC3) 

END  IF 

CALL  KFILTCZ) 

IF  C  JMFLAG. ED. 1 )  THEN 
DO  915  J=1 , 4 
XTEMP  C J ) =XHP  C J ) 

DO  915  KK=5f 12 
XTEMP  CKK)  =0.0 
915  CONTINUE 
ELSE 

DO  980  J= 1 f  4 
XTEMP C  J ) =XHM ( J) 

DO  980  KK=5, 12 
XTEMP  CKK J =0. 0 
980  CONTINUE 
END  IF 

CALL  GCSTARC XTEMP, NFLAG) 

DO  250  J=1 , 12 

XOLDC J)=XTEMPC J) 

250  CONTINUE 

DO  260  J=l,4 

UOLDC J)=UNEWCJ) 

260  CONTINUE 

DO  262  J=l,4 

UCOLDCJ)=UCMDC J) 
xmoldcj)=xmcj:> 

262  CONTINUE 

ELSE 

CALL  GCSTARC X, NFLAG) 

DO  1060  JM=1 ,12 
XOLDCJI  )=XCJM) 

1060  CONTINUE 

DO  1070  JM=1 , 4 
XMQLD  C JM) =XM  C JM) 

UCOLD C JM ) =UCMD C JM > 

UOLDC JM)=UNEWCJM) 

1070  CONTINUE 
END  IF 

CALL  ODE  CFSTOL, 12, X, T, TOUT, RELERR, ABSERR, I FLAG, WORK, I  WORK 
T=TOUT 

IF  C I FLAG. NE. 2)  THEN 

PRINT’  C"  I FLAG  =  ",  12) ’  , IFLAG 
ELSE 

I FLAG = -2 
END  IF 

300  CONTINUE 
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780  CONTINUE 

IF(IIFLAG.EQ.O)GO  TO  1310 
DO  755  1=1,51 

out  a ,  i )  =out  <:  i ,  i  >  /  x  i  ter 
OUT  a, 2)=0UT( 1 ,2) /XITER 
OUT  (1,3)  =OUT  <  1 , 3 )  /  x  i  ter 
OUT  (1,4) =OUT  C 1 , 4 ) / X  I  TER 
OUT  1(1,1) =OUT 1 ( 1 , 1 ) / X I  TER 
OUT  1 ( I , 2)=0UT1 C 1 , 2) /XITER 
OUT  1(1,3) =OUT 1(1,3)/ XITER 
OUT 1(1,4) =OUT 1 (I, 4) /XITER 
0UT1 ( I , 5)=0UT1 ( I ,5) /XITER 
U0UT2 (1,1) =U0UT2 ( 1 , 1 ) / X I  TER 
U0UT2 (1,2) =U0UT2 ( 1 , 2) / XI  TER 
U0UT2C I , 3>=U0UT2C 1,3) /XITER 
UGUT2 (1,4) =U0UT  2 ( I , 4) / X I TER 
U0UT3 (1,1) =U0UT3 ( 1 ,  1 )  /  X  I  TER 
U0UT3 ( I , 2)=U0UT3C I , 2) /XITER 
U0UT3 (1,3 ) =U0UT3  C 1 , 3 ) / X I TER 
U0UT3 (1,4) =U0UT3 ( I , 4 ) / X  I  TER 
U0UT3 (1,5) =U0UT3 ( 1 , 5 ) / X I  TER 
755  CONTINUE 
1310  CONTINUE 

393  PRINT*, '  1 =OUTFUT  VARIABLES  2=C0NTR0L  INPUTS  ' 
PRINT*, '  3= CONTROL  DEFLECTIONS  4=SYSTEM  STATES 
READ*,  MMFLAG 

GO  TO  (1000,1100,1200,1300)  MMFLAG 
1000  CALL  SETPLT (OUT, 51,5, PLTVEC) 

PRINT*,'  + - ENTER  TITLE  FOR  PLOT — 

PRINT* 

READ ( * , '  (A)  ’  ) TITLE 

CALL  PLOTLPC PLTVEC, 51, 3,-1, 1,0, TITLE) 

GO  TO  1400 

1100  CALL  SETPLT (OUT 1,5 1,5, PLTVEC) 

PRINT*,'  + - ENTER  TITLE  FOR  PLOT  — 

PRINT* 

READ (*, ’  (A)  ’  ) TITLE 

CALL  PLOTLP (PLTVEC, 51,4, -1 ,  1,0, TITLE) 

GO  TO  1400 

1200  CALL  SETPLT (U0UT2, 51,5, PLTVEC) 

PRINT*,'  + - ENTER  TITLE  FOR  PLOT — 

PRINT* 

READC*,  ’  (A) '  )  T I TLE 

CALL  PLOTLP (PLTVEC, 51, 3,-1, 1,0, TITLE) 

GO  TO  1400 

1300  CALL  SETPLT (U0UT3, 5 1,5, PLTVEC) 

PRINT*,  '  + - ENTER  TITLE  FOR  PLOT  — 

PR  I  NT* 

READC*,  '  (A)  '  (TITLE 

CALL  PLOTLP (PLTVEC, 51, 4,-1, 1,0, TITLE) 

1400  PRINT*,'  MORE  OUTPUT  PLOTS?' 

READC*,  '  (A)  ’  )  ANSW 

IF(ANSW.NE. 'Y' . AND. ANSW. NE. ’N’ )  GO  TO  1500 
IF  (ANEW.  EC!.  '  Y'  )  GO  TO  993 
1500  CONTINUE 
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o  o  o  o  o  o  o  o  o 


r  r  w  >  v>j  t  j  tj  vj  ■!  v 


3214  PRINT:*:,  ’  INPUT  NAME  FOR  CALCOMP  PLOT  OF  OUTPUT' 

READ  (:*,  '  <A> ’  )PLOT 

0PENC5,FILE=PL0T, STATUS=’NEW’ , FORM=’ FORMATTED’ , ERR=3214) 
WRITE (5, FMT=’ C4E20.5) ' ) C COUTCJ, I ) , 1=1 , 4 ) , J=1 , 5 1 ) 

ENDFILE (5) 

REWIND (5) 

CLOSE (5) 

3215  PRINT:*,  ’  INPUT  NAME  FOR  CALCOMP  PLOT  OF  CTRL.  DEF.  ’ 

READ  <!  :*,  '  C  A  )  '  )PLOT 

□PENCE,  FILE--PLOT,  STATUS=’  NEW’  ,  FORM=  ’  FORMATTED ’  ,  ERR=3215) 
WR I TE  C 6 , FMT  = ’  ( 4E20 .  5 )  ’  )  c  C U0UT2 C J ,  I > , I  =  1 , 4 ) , J=1 , 51 > 
ENDFILE (6) 

REWIND  >.  G ) 

CLOSE  CO) 

525  PRINT:*,  ’  CHANGE  MATRICES?  Y/N:  ’ 

READ  C  :*,  ’  CA)  ’  .)  ANSW 

IFCANSW.NE. ’ Y’ . AND. ANSW.NE. »N’ )  GO  TO  525 
I F  C  ANSW .  EG! .  ’  Y  ’  )  GO  TO  142 
530  PRINT*, ' MORE  RUNS  WITH  NEW  MODEL?  Y/N:  ’ 

READ  (:*,  ’  CA)  ’  )  ANSW 

IFCANSW.NE. ’Y’ .AND. ANSW.NE. 'N' >  GO  TO  530 
IFCANSW.EQ. ’ Y’ )  GO  TO  20 
END 
C 

C  END  PROGRAM  0DEF15  - 

C 

C 


SUBROUTINE  FSTOLCT, X , DX) 
C 

c 

c 


;*:*:*:*:*:**:*  .r  *:*■*:*:** 


C  THIS  IS  A  SET  OF  FIRST  ORDER  ORDINARY  DIFFERENTIAL  EDUAT I ONS  THAT 
C  DEFINE  THE  THE  DYNAMICS  OF  THE  STOL  F-15  AIRCRAFT. 

C  ACTUATOR  DYNAMICS  APE  INCLUDED  AS  ENTERED  IN  THE  12  X  12 
C  A  MATRIX  WHICH  HAS  BEEN  ENTERED  AT  THE  ONSET  OF  THE  PROGRAM 
C  IT  IS  ASSUMED  THAT  SECOND  ORDER  ACTUATORS  ARE  ASSOCIATED  WITH 
THE  STABILATOR  AND  CANARD,  AND  FIRST  ORDER  WITH  THE  NOZZLE. 

NOTE  THAT  A  NON-LINEARITY  IS  INTRODUCED  INTO  THE  MODEL  BY  THE 
CONTROL  OF  BOTH  THRUST  AND  NOZZLE  DEFLECTION. 


4::*4:4:*:*  *:*:*.*  *:*:*:*:*.*:*:*4:.*:*:*:*:*:*:*  *:**  *.*:*:*:*:**  *:*:*.*  *:*:*.*.*  *.*:*:*  *:*:*:*:*:*:*4:*:*.*:*:*:**.:*:*  *  4  *  * 


REAL  T, X  C 12) , DX  C 12) , BNL  C3,3) 

COMMON/MATRIX /U0C2) , A C 12, 12 ) , C < 4,  12) , KX  c4,  12) , KZ C4, 4) , KXMC4, 4) 
1 ,  K  X  U  C  4 , 4 )  ,  PH  I  C  4 , 4  >  ,  PH  I  NT  *4,4.),  _Mc4,  4  )  ,  B  3 , 3  )  ,  EV  C  2  )  ,  KFLAb  ,  MM 

COMMON /CONTRL/UNEW  C 4 ) ,U0LDC4) , UCMDC4) , UCOLD C 4 ) 

1, XOLDC 12) , XM0LDC4) , X M  C 4 ) , MFI  .AG,  EVA C2) 


DO  444  1=1,3 
DO  444  J= 1 , 3 
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8D-A164  188  AN  LOG  UP-AND  flUflV  FLIGHT  CONTROL  DESIGN  FOR  THE  STOL  3/2 
F-15  AIRCRAFT (U)  AIR  FORCE  INST  OF  TECH 
URIGHT-PATTERSON  AFB  OH  SCHOOL  OF  ENGINEERING 
UNCLASSIFIED  R  A  HOUSTON  DEC  85  AFIT/GE/ENG/85D-21  F/G  1/4  NL 


V  -» 


MICROCOPY  RESOLUTION  TEST  CHART 

national  bureau  of  standards- 1963-A 


•>  .*• 

-  4.’  •  ’  ■  “  >  ’  .  *  .  f  4 


BNL  < I , J1=0. 

4  CONTINUE 

SET  THE  SIGN  TO  ACCOUNT  FOR  CONTROL  SURFACES  PASSING 
THROUGH  A  ZERO  ANGLE  OF  ATTACK  RELATIVE  TO  THE  A/C 


EVA  < 1 1=EV < 1 1 +X  <31 
EVA  < 2 1  =E  V  ( 2 1  +  X  ti  3.1 
DO  5000  11=1,3 

BNL<II,31=B<II,31 
DO  5000  JJ=1 , 2 

BNL (II, JJ 1  =B  <  1 1 ,  JJ1 
IF  <  EVA  C  J  J 1  .  GE .  0 1  THEN 

IF  ( <U0<JJ1+EVA<JJ1 1.LT.01  THEN 
BNLU,  JJ1=-BC1,  JJ1 
END  IF 
ELSE 

IF < <U0< JJ1+EVACJJ1 1.GT.01  THEN 
BNLC1, JJ1=-BC1, JJ1 

END  IF 
END  IF 

CONTINUE 
IFCMM.EQ. 1 1  THEN 

DX  C 1 1 =A  < 1 , 1 >*X  < 1 1 +A < 1 , 21  *X  <21  +A(1 , 31  *X  <31 +A  Cl ,  41  *X  <41 
1 +BNL C 1 ,  1 1 *UNEW < 1 1 +BNL  <1,2 1 *UNEW  < 2 1 +BNL  <1,3 1 *UNEW  <  3 1 
DX  <21  =A  <2,  1 1  *X  <11 +A  <2, 21 *X  <21 +A  <2, 31 *X  <31 +A  <2,  41 *X  <41 
1 +BNL <2,11 *UNEW  < 1 1 +BNL  <2,2 1 *UNEW <  2 1 
DX  <31  =A  <3,  1  I  t' X  <1 1+AC3,  21 *X <21 +A<3, 31 *X  <31 +A  <3,  41  *X  <41 
1 +BNL (3,11 *UNEW ( 1 1 +BNL <3,21 *UNEW  <2 1 
DX  <4 1 =X  <21 
DX  <51=0. 

DX  <61=0. 

DX  <71=0. 

DX  <81=0. 

DX  <91=0. 

DX  < 101=0. 

DX< 111=0. 

DX  <  121=0. 

U0< 1 1=UNEW< 11 
UO  <  2 1 =UNE W  <21 
X  <51 =UNEW  <11 
X  <71 =UNEW  <21 
X  <91=UNEW<3! 


ELSE 

DX  <  1 1=A  <1 ,  1  1*X  <  1  !+A<  1 , 21  :*  X  C21+A <1,31  *X  <31  +A< 
1 +BNL  <  1 ,  1 1 *X  <5! +BNL  <  1 , 2!  *X  <  7 1  +BNL  <  1 , 3!  *X  <91 

DX<2)=A<2,  1  1*X  <  1 1+A<2,21*X<21+A<2,  31  *X  <31+A< 
1 +BNL (2,  1 1  X  < 3 >  +BNL<2, 21  *X  < 7 1 

DX<3!=A<3, 1 1*X < 1 !+A<3,21*X <2)+A<3,31*X  <31+A< 
1+BNL (3,  1 1  X  <5 1  +BNL  <3, 2 1  *X  <  71 
DX  <4!=X  <21 
DX (51 =X  <  61 

DX  <61 =-8356. *X  <51-303. *X <61+8356. *UNEW < 1 1 
DX<71=X<81  181 


1,41  *; 


2,41* 


1  + A  <3,41* 


DX  <8 ) =-8356 . *X  ( 7 ) -303 . *X  CB) +8356 . *UNEW ( 2 ) 

D  X  <  9 ) =-20 . *  X  <  9 >  +20 . :*UNEW  <  3 ) 

dx  c  10)  =o. 

DX ( 1 1 ) =0. 

DX  C  12)  =0. 

U0(1)=X<5) 

U0C2)=X(7) 

END  IF 

IFCMFLAG.EQ. 1 ) THEN 

I F  C  X  (  5 )  .  GE.  .  262.  AND.  DX  (5)  .  GT.  0.0)  DX  C 5 )  =0 .  0 
IF(X(5) .LE.-.611. AND.DXC5) . LT. 0. 0) DX C5) =0. 0 
IF C  X  ( 6) .GE. . 401 . AND. DX (6) . GT. 0. 0)DX  C6)=0. 0 
IF(X(6). LE. -. 401 . AND. DX (6) . LT. 0. 0)DX (6) =0. 0 
IFCXC7).  GE .  .262.  AND.  DX  (7) .  6T.O.ODX  (7)  =0.0 
IFCX  <7) . LE. -.506. AND. DX  (7)  . LT.O. 0>DX (7) =0.0 
IFCXC8)  .  GE. .803. AND. DX <8 ) . GT . 0. 0) DX (8) >0.0 

IFCX (8) .LE.-. 803. AND. DX  C8) . LT. 0.0)DX  C8)=0.0 
END  IF 
RETURN 
END 


C 

C  END  PUBPROGRAM  FSTQL 


ft 


iv. 


c 

c 


SUBROUT I NE  GCSTAR C  X  ,  NFLAG ) 


C 


s-  : 

CALL 

y 

V ■ 

CALL 

■  V 

CALL 

CALL 

CALL 

CALL 

>’■ 

> 

CALL 

y 

CALL 

$ 

CALL 

CALL 

0 

CALL 

a? 

CALL 

CALL 

CALL 

CALL 

C*4  4'  *  *  t  *  *  *  :*  *  *  4  *  4  *  *  :*  4  4'  :*  *  4  *  4'  *  *  4  *  T  4-  :*  *  %  %  *  4  *  4  %  %  *  *  *  *  *4'  *  *  4  *  4  *  *  *  *  4  *  4  4  *  *  *  *  X  t  *  4  * 
C 

C  SUBROUTINE  TO  CALCULATE  THE  CONTROLS  AT  EACH  SAMPLE  TIME. 

C  ANTI-WINDUP  COMPENSATED  IF  NFL A6= 1 . 

C 

C*  *  *  *  *  *  *:****:*:  *  *  *  :*  *  *  *  *  *  *  *  *  *  *  *  *  4  ******  *  :*  *  *  *  *  *  4'  *  *  *  *  *  *  *  4.  ******  *  4  *  T  *  4  *  *  *  *  *  * 
C 

REAL  XC12) , DEL (12) , DEL2C12) 

INTEGER  NFLAG 

COMMON/MATRIX /UO (2) , A  C 12P 12) t CC4, 12) , KX (4, 12) , KZ (4, 4) , KXM (4, 4) , 

1  KXUC4, 4) , PHI (4,4), PHINT (4,4), CM(4, 4) , B (3, 3) , EV (2) , KFLAG, MM 
COMMON/ CONTRL/UNEW ( 4)  , UOLD (4) , UCMD (4) , UCOLD (4) , X0LDC12) , 

1  XM0LDC4) , XMC4) , MFLAG, EVA (2) 


MATSB (X, XOLD, DEL, 12,1) 
MATML (KX, DEL, DEL2, 4, 12, 1) 
MATSBCUOLD, DEL2, UNEW, 4, 1) 
MATSBCXM, XMOLD, DEL, 4, 1) 
MATMLCKXM, DEL, DEL2, 4,4,1) 


MATSB ( UCMD , UCOLD , DEL ,4,1) 
MATMLCKXU, DEL, DEL2, 4, 4, D 
MATAD (UNEW, DEL2, UNEW, 4 , 1) 
MATML (CM, XMOLD, DEL, 4,4, 1) 
MATML (C, XOLD, DEL2, 4, 12,1) 
MATSB  C  DEL , DEL2 , DEL ,4,1) 
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CALL  MATMLCKZ, DEL, DEL2, 4, 4, 1 ) 

CALL  MATADCUNEW, DEL2, UNEW, 4,  1) 

IF (NFLAG. EQ. 1 )  THEN 

IF  CUNEW  <:  1 )  .  GT.  . 49-.87*XC5)  )UNEWC 1 >=< . 49-. 87*X (5)  )*1. 

IF (UNEW < 1  )  .LT.-l .  14-.87*X(5i  )UNEW(  1)  =  (-1.  14-.  B7*X (5) ) *1 . 
IFCUNEWC2)  .GT.  . 49-. 87*X <7)  )  UNEW  (2)  =  .  49-.  B7*X  C7) 

I F  < UNEW  (  2  )  .  LT .  - .  96- .  87*X  C  7  )  )  UNEW  <  2  > ■- . 96- . 87* X  <  7 ) 

IF < UNEW ( 1 ) . GT. . 706+ X (5) >UNEW  <1)*. 706+ X <5> 

I F ( UNEW  < 1 ) . LT . - . 706+ X  ( 5 ) ) UNEW ( 1 ) =- . 706+  X  C  5 ) 

I F  C  UNEW  (  2  !> . GT . 1 . 522+  X ( 7 ) > UNEW < 2 )  =  1 . 522+ X  C 7 ) 

IF  (UNEW (2) . LT. -1 . 522+ X (7) > UNEW (2) =- 1 . 522+ X (7) 

END  IF 
RETURN 
END 
C 

C  END  SUBROUTINE  GCSTAR  - 

C 

C 

SUBROUT I NE  RPOUT  < A  ,  M , N ) 

C 

C********************************************************************* 

C 

C  THIS  ROUTINE  PRINTS  OUT  A  REAL  MATRIX  A 
C 

C********************************************************************** 

C 

REAL  A  <  M ,  N  ) 

INTEGER  I,J,N,M 
DO  200  1=1, M 

PRINT’  (•'  ,  5  (  E 1 1 . 4 ,  3X  )  >  ’  ,  (  A  (  I  ,  J  )  ,  J=  1 ,  N ) 

PRINT* 

200  CONTINUE 
END 
C 

C  END  SUBROUTINE  RPOUT  - 

C 

C 

SUBROUTINE  SETPLT (A, N, M, X) 

C 

C********************************************************************* 

c 

C  THIS  ROUTINE  CONVERTS  A  REAL  MATRIX  OF  DIMENSION  N  BY  M  INTO  A 
C  VECTOR  THAT  IS  COMPATIBLE  WITH  R.M.  FLOYD’S  PRINTER  PLOTTING 
C  ROUTINE,  PLOTLP.  THE  INPUT  MATRIX  IS  A. 

C  N=  ROW  DIMENSION  OF  A,  THE  NUMBER  OF  POINTS  TO  BE  PLOTTED 
C  M=  COLUMN  DIMENSION  OF  A,  THE  NUMBER  OF  FUNCTIONS  TO  BE  PLOTTED  +1 
C  X=  THE  PLOTTING  VECTOR,  DIMENSION  N*M 
C 

c********************************************************************* 

c 

REAL  A ( N , M ) , X ( N*M ) 

INTEGER  N, M, I , J 
DO  lOu  J  - 1 ,  M 
DO  100  I  =  1 , N 

X  <  I  +  <.  J- 1  )  *N  )  =A  <  I ,  J  ) 
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100  CONTINUE 
END 

END  SUBROUTINE  SETF'LT 


SUBROUTINE  PLDTLP C A, N, M, IPSC, ISCL, LPTERM, TITLE) 

C 

C********  :#:**:* :4c  ***  :*;*:*::*;  :+c 

C 

C  THIS  ROUTINE  WAS  ADAPTED  PROM  R.M.  FLOYD'S  THESIS  TO  PRODUCE 
C  PRINTER  PLOTS  OF  COMPUTED  RESULTS. 

C  A=  VECTOR  OF  DATA,  CONVERTED  FROM  MATRIX  FORM  BY  SUBROUTINE  SETF'LT 
C  N=  NUMBER  OF  POINTS  ( INDEPENDENT  VARIABLE)  TO  BE  PLOTTED 
C  M=  NUMBER  OF  FUNCTIONS  (.DEPENDENT  VARIABLES)  TO  BE  PLOTTED 
C  IPSC  =  -1 — >ALL  VARIABLES  SCALED  TOGETHER  (1  PLOT) 

C  =  0 — >SCALED  TOGETHER  AND  SEPARATELY  <2  PLOTS) 

C  =  +1  —  >SCALED  SEPARATELY  Cl  PLOT) 

C  ISCL  =  0 —  >F'LOT  OVER  EXACT  RANGE  OF  VARIABLE 

C  +1 — >PLOT  WITH  EVEN  SCALING 

C  LPTERM  =  0 — >F'LOT  50  CHARACTERS  WIDE 
C  +1  —  >PLOT  100  CHARACTERS  WIDE 

C  TITLE  =  MAX  OF  50  CHARACTERS,  TYPE  CHARACTER 
C 

C*:#:*******  4c  :*•-  *X*X%t*X*  *:**:**:*:*:***:*  **  *:*  :**:****:**■.**:**:** 

C 

REAL  YSCAL  C  & ) ,  YM I N  C  &  )  ,  YF'R  C 1 1 )  ,  R I SPAC ,  RM I N ,  RMA X  ,  YL ,  YH ,  XPR ,  A  C * ) 
REAL  SCAL 

INTEGER  IBLNKC&) , IPSC, ISCL, LPTERM, I PAPER, I SPAC, IPRTI, ISC, J, I C, IX 
INTEGER  IL,  JP,  ITEMF',  Ml ,  M2,  M,  N,  ICO,  I 
CHARACTER  TITLE*50 

CHARACTER# 1  BLANK , PLUS , COLON , GR I D , SYMBOL  C  & ) , OUT  C 1 0 1 ) 

DATA  BLANK, PLUS, COLON, SYMBOL C 1 ) , SYMBOL C2) / *  ',’+',':»,'l','2'/ 
DATA  SYMBOL C 3 ) , SYMBOL C 4 ) , SYMBOL C 5 ) , SYMBOL CS) /' 3’ , ' 4' , ' 5' , ' £’ / 

I PAPER=5* < 1 +LPTERM ) 

I  SF‘ AC=  1 0#  I  PAPER 
RISPAC=REAL  C I SPAC) 

I SP  AC= I SP AC+ 1 
I PRT I = I P APER+ 1 
RM I N=A  C  N+ 1 ) 

RMAX=RMIN 
25  DO  41  ISC=1 , M 
M1=ISC*N+1 
YL=ACM1 ) 

YH=YL 

M2=N#  C I SC+ 1 ) 

DO  40  J=M 1 , M2 

IF  C A  C J) . LT. YL) THEN 
YL=ACJ) 

END  IF 

IFCA  C J) . GT. YH) THEN 
YH=AC J) 

END  IF 

40  CONTINUE 

IFCYL.LT. RMIN)THEN 
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RMIN=YL 
END  IF 

IF(YH. ST. RMAX) THEN 

•  RMAX=YH 

END  IF 

IF  < IPSC. GE . 0) THEN 

CALL  VARSCL  (YLf  YH, YSCAL ( ISC) , R ISPAC,  ISCL) 

END  IF 

YMIN( ISC)=YL 

^  41  CONTINUE 

IFCIPSC.LE.O)  THEN 

CALL  VARSCL (RMIN, RMAX, SC ALf RISP AC, ISCL) 

END  IF 

IC«2-IABSCIPSC) 

DO  42  IX=1 , ISP AC 

•  OUT  C I X ) "BLANK 
42  CONTINUE 

DO  100,IC0=1,IC 

PRINT' ("l", 11X, A50) ’ f  TITLE 
WRITE  <4, ’ (  1 1  X , A50) ’ ) TITLE 
WR I TE  C  4 ,  »  <  A 1 )  ’  )  BLANK 
**  PRINT* 

DO  GO  1  =  1,  N 
XPR=A  ( I ) 

IF  (MOD  <1,  10)  .EQ.OTHEN 
GRID=COLON 
ELSE 

*  GRID=BLANK 

END  IF 

DO  44  I  X=2, I SPAC, 2 
OUT  (IX) =GR I D 
44  CONTINUE 

DO  4G  IX*1, ISPAC, 10 

*  OUT  C  IX ) =PLUS 

46  CONTINUE 

DO  55  J=1,M 
IL=I+J*N 

IF (IPSC. EQ. -1 ) THEN 

JP= I  NT  (  C  A  (I L  )  -RM  IN)/  SC  AL )  + 1 
ELSE  IF  (IPSC.  EQ.OTHEN 
I PSCT  =  I  F’SC+ 1  CO 
IF(  IPSCT.  EG*.  2)  THEN 

JP=INTC  CA(IL)--YMIN( J)  ) /YSCAL(J) )  +  l 
ELSE 

JP=INTC  (AC  ID-RMIN)  /SCAD  +  l 
r  END  IF 

ELSE 

JP=INT<CA(IL)-YMIN(J) )/YSCALCJ))+l 

END  IF 

50  OUT ( JP) =SYMBOL( J) 

IBLNKt J) =JP 

£.  55  CONTINUE 

PRINT’ (M  ",F11.4,6X, 101A1) ' , XPR, (OUTCIX) f IX  =  1, ISPAC) 
WRITE <4, ’ (F11.4, 6X, 101A1) ’ )XPR, (OUT ( I X ) f I X  =  1 , ISPAC) 
DO  53  J=1,M 


o  o  o  o  o  o  o  o  o  o  o  o 


ITEMP=IBLNKCJ) 

OUT  < I TEMP ) =BLANK 
59  CONTINUE 

£0  CONTINUE 

IFCIPSC.NE. 1 ) THEN 

I F  ( I PSCT . NE . 2 ) THEN 
YPRCJ >=RMIN 
DO  70  1  =  1 , I PAPER 

YPR C I + 1 ) =YPR (15+10. *SCAL 
70  CONTINUE 

PRINT' ("0  SCALE  " , 1 1E10. 3) ’ , C YPR C I ) , 1=1 , IF'RTI) 
WRITE <4, ' CAl) ’ ) BLANK 

WRITE  C 4,  ’  C  "  SCALE  "  ,  1 1E10.  3)  ’  )  C  YPR  C  I  )  f  1  =  1 ,  IF'RTI ) 
WRITE (4, ' CAl 5 D BLANK 
WRITE C4,  ’  CAD  '  ) BLANK 
END  IF 
END  IF 

IFCIPSC.EQ. l.OR. I PSCT . EG . 2 )  THEN 
DO  76  I SC= 1 , M 

YPR  CD  =YM  I N  C  I  SC  ) 

DO  74  1  =  1 , I PAPER 

YPR  C I  + 1) =YPR C  I )  + 1 0 . TYSCAL C I SC  ) 

74  CONTINUE 

PRINT' C " 0  SCALE  " , A1 , 1 X , 1 1E10. 3) ' , SYMBOL! ISC) , C YPR C I 

1,  IX=1,  IF'RTI  ) 

WRITE C4f '  CAl)' ) BLANK 

WRITEC4, ' C "  SCALE  " , A1 , 1 X f 1 1E10. 3) ') SYMBOL C ISC) , 
1CYPRCIX),  IX=1,  IF'RTI) 

76  CONTINUE 

END  IF 

DO  90  I SC=1 , 56-N 

WRITEC4, ' CAl) ’ ) BLANK 
90  CONTINUE 

100  CONTINUE 

PRINT'  Cl")' 

END 

END  SUBROUTINE  PLOTLP  - 


SUBROUTINE  VARSCLCXMIN, XMAX , SCALE, RSPACE, ISCL) 

THIS  IS  A  SCALING  ROUTINE  THAT  SUPPORTS  PLOTLP 
ADAPTED  FROM  R.M.  FLOYD'S  THESIS 

REAL  XMIN, XMAX, SCALE, RSPACE, EXP, XMINT, XMAXT 
INTEGER  ISCL, ISCAL 
IFCXMAX.EQ. XMIN) THEN 
XMIN=.9*XMIN-10. 

END  IF 

SCALE=XMAX-XMIN 
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IF  C  ISCL.  NE.  CO  THEN 

E  XP= I NT  Cl 00 . +LQG 1 0  C  SCALE ) >-100. 
FACT0R=  1 0 .  **  C  1 .  -E XP  ) 

XliINT =XMIN*F  ACTOR 
XMAXT=XMAX*F  ACTOR 
IFCXMAXT.GE.O. ) THEN 
XMAXT=XMAXT+. 9 
END  IF 

IFCXMINT.LE.O. ) THEN 
XMINT=XMINT-.3 
END  IF 

XMINT=AINT  CXMINT) 

ISCAL=XMAXT— XliINT 
I F  C  MOD  < I SCAL , 5 ) . NE . 0 ) THEN 

I SCAL= I SC AL+5-MQD  C I SC AL , 5) 
END  IF 

F ACTOR= 10. **C EXP- 1. ) 

XMIN=XMINT*FACTOR 

SC ALE=F ACT OR*RE AL C I SCAL  > 

END  IF 

SCALE=SCALE/RSPACE 

END 

END  SUBROUTINE  VARSCL  - 


SUBROUTINE  EDIT CEDMAT, M,  N) 

s******************************************************************** 

THIS  ROUTINE  ALLOWS  THE  USER  TO  EDIT  AN  M  BY  N  MATRIX  EDMAT 

L*  ********************************************  *****  *  '*  *  *  *  *  *  *  .*  *  *  *  *******  * 
C 

REAL  EL, EDMAT CM, N) 

INTEGER  M,N,  I, J 
CHARACTER  ANSW*1 

10  PRINT*, "LIST  CURRENT  VALUES?  Y/N:  ’ 

READC*, ’ CA) ’ )ANSW 

IFCANSW.NE. »Y» .AND. ANSW.NE. ’N’ >  GO  TO  10 
IF CANSW.EQ. ’  Y’ )  CALL  RPOUT CEDMAT, M, N) 

PRINT*, ’ENTER  0,0,0  <CR>  WHEN  ALL  CHANGES  HAVE  BEEN  MADE’ 

100  PRINT*, ’ENTER  ROW  #,  COLUMN  #,  AND  MATRIX  ELEMENT:  ’ 

110  READ*, I, J, EL 

IFCI.GT.O. AND. I . LE. M. AND. J. GT. 0. AND. J. LE. N) THEN 
EDMAT  C I , J)=EL 
GO  TO  110 

ELSE  I F C I . EO. O . AND. J . EQ . 0 > THEN 
150  PRINT*, ’LIST  MODIFIED  MATRIX?  Y/N:  ’ 

READ ( * , ’ CA) ’ ) ANSW 

IFCANSW.NE. ’Y’ .AND. ANSW.NE. ’N’ )  GO  TO  150 
IF CANSW.EQ. ’ Y’ >  CALL  RPOUT CEDMAT, M, N> 

200  PRINT*, 'ANY  MORE  CHANGES  TO  THIS  MATRIX?  Y/N:  ’ 

READ  C*, ’  CA) ’ ) ANSW 

IFCANSW.NE. »Y’ .AND. ANSW.NE. ’N’ )G0  TO  200 
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IFCANSW.EC!. ’ Y» )Q0  TO  100 
IFCANSW.EC!. ’N’ ) RETURN 
ELSE 

PRINT*, 'SUBSCRIPT  OUT  OF  RANGE’ 

GO  TO  100 
END  IF 
END 
C 

C  END  SUBROUTINE  EDIT - 

C 

c 

SUBROUTINE  MATML ( A, B, C, L, M, N) 

C 

C********************************************************************* 

C 

C  THIS  ROUTINE  WILL  MULTIPLY  TWO  REAL  MATRICES 
C  A=AN  L  BY  M  MATRIX 
C  B=AN  M  BY  N  MATRIX 
C  C=THE  L  BY  N  PRODUCT  OF  A  AND  B 

C  NOTE:  ACTUAL  ARGUMENT  C  MUST  DIFFER  FROM  A  AND  B 
C 

C********************************************************************* 

c 

REAL  ACL, M)  ,BCM,Ni>  ,CCL,N) 

INTEGER  I,J,K,L,M,N 
DO  100  1  =  1,  L 
DO  100  J=  1 , N 
C  C I , J ) =0 . 0 
100  CONTINUE 

DO  200  1=1 , L 
DO  200  J= 1 , N 
DO  200  K= 1 , M 

CCI, J)=CC I, J)+ACI ,K)*BCK, J) 

200  CONTINUE 
END 
C 

C  END  SUBROUTINE  MATML  - 

C 

C 

SUBROUTINE  MATAD C A, B, C, L, M) 

C 

C********************************************************************* 

c 

C  THIS  ROUTINE  ADDS  TWO  REAL  MATRICES  OF  DIMENSION  L  BY  M 
C  A  AND  B  ARE  THE  INPUTS,  C  IS  THE  SUM 
C 

C********************************************************************:** 

C 

REAL  ACL,M> , BCL,M) ,CCL,M) 

INTEGER  I , J, L, M 
DO  100  1=1, L 
DO  100  J= 1 , M 

CCI, J)=ACI, J)+BCI, J) 

100  CONTINUE 
END 
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C  END  SUBROUTINE  MATAD  - 

C 

C 

SUBROUTINE  MATSB C A, B, C, L, M> 

C 

C 

C  THIS  ROUTINE  SUBTRACTS  REAL  MATRIX  B  FROM  REAL  MATRIX  A 
C  DIFFERENCE  IS  RETURNED  IN  REAL  MATRIX  C. 

C  ALL  THREE  MATRICES  ARE  OF  DIMENSION  L  BY  M 
C 

C 

REAL  ACL,M) ,BCL, M) , CCL, M) 

INTEGER  I,J,L,M 
DO  ICO  1  =  1,  L 
DO  ICO  J=1,M 

CCI, J)=A(I, J)-BCIf J) 

100  CONTINUE 
END 
C 

C  END  SUBROUTINE  MATSB  - 

C 

C 

SUBROUTINE  SMUL C Af B, C, L, M> 

C 

C 

C  THIS  ROUTINE  MULTIPLIES  A  REAL  MATRIX  BY  A  REAL  SCALAR 
C  A=  THE  SCALAR 
C  B=  THE  MATRIX 
C  C=  THE  PRODUCT 

C  B  AND  C  ARE  OF  DIMENSION  L  BY  M 
C 

C 

REAL  A, B(LrM) ,CCLPM) 

INTEGER  I,JfL,M 
DO  100  1=1, L 
DO  100  J=1 , M 

CCI,  J)=A:*BCI,  J) 

100  CONTINUE 
END 
C 

C  END  SUBROUTINE  SMUL  - 

C 

C 

SUBROUTINE  COPYMT C A, B, N, M) 

C 

C 

C  THIS  ROUTINE  COPIES  A  REAL  MATRIX  A  INTO  REAL  MATRIX  B. 

C  BOTH  MATRICES  ARE  OF  DIMENSION  N  BY  M. 
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C**»*****.l:*.<c*:*^*lc***5»c***.i:*4r*:*:4c*^-4:*-*«^t*4c^**^4:4c:*;:*:^*:*:***:|c:*:»»^**^*.tct*:*. 

C 

REAL  ACN,M) ,B<N,M) 

INTEGER  I,J,N,M 
DO  100  1=1, N 
DO  100  J= 1 , M 

BCI, J)=ACI, J) 

100  CONTINUE 
END 
C 

C  END  SUBROUTINE  COPYMT  - 

C 

c 

SUBROUT I NE  DSCRT C A , N  f TS AMP , PH I , PH I NT , M , TP , T I  DENT , CWDRK > 

C 

C 

C  THIS  ROUTINE  APPROXIMATES  THE  STATE  TRANSITION  MATRIX  AND  ITS 
C  INTEGRAL  FOR  A  TIME  INVARIANT  LINEAR  SYSTEM  AS  A  MATRIX  EXPONENTIAL 
C  OVER  A  SMALL  SAMPLE  PERIOD.  RESULTS  RETURNED  IN  REAL  MATRICES. 

C  A=  SYSTEM  DYNAMICS  MATRIX,  TYPE  REAL 
C  N=  STATE  DIMENSION 
C  TSAMP=  SAMPLING  PERIOD 

C  F‘HI=  STATE  TRANSITION  MATRIX,  TYPE  REAL 
C  PHINT  =  APPROXIMATE  INTEGRAL  OF  PHI,  TYPE  REAL 
C  M=  NUMBER  OF  TERMS  USED  IN  EXPONENTIAL  EXPANSION 
C  TP,  T I DENT  AND  CWDRK  ARE  DUMMY  ARRAYS 
C 

C 

REAL  A<N,N) , PHINT <N,N) , PHI CN,N)  ,  TIDENTCN,  N)  ,TPCN,N> 

REAL  CWORK CN,  N> 

REAL  TSAMP, RI J 
INTEGER  I , J, M, N 
DO  200  1=1, N 
DO  100  J= 1 , N 

T I DENT  C I , J ) =0 . 0 
100  CONTINUE 

T I DENT ( I , I) =1.0 
200  CONTINUE 

CALL  SMUL  <  TSAMP ,  T I  DENT ,  F'H  I  NT ,  N ,  N ) 

CALL  COPYMT  (PHINT,  TF' ,  N,  N) 

CALL  SMUL C TSAMP, A,FHI,N,N) 

DO  300  1=1, M 

CALL  M ATML  t  TP , PH I , CWORK , N , N , N  > 

CALL  COPYMT (CWORK, TP, N, N) 

RI J=l. O/REAL ( 1+1 ) 

CALL  SMUL  (.R.  I  J,  TP,  TP,  N,N> 

CALL  MAT AD  C PH I NT , TP , PH I NT , N , N ) 

300  CONTINUE 

CALL  MATML  < A , PH I NT , TP , N , N , N  > 

CALL  MATAD ( T I  DENT, TP,PHI,N,N) 

C 

C  END  SUBROUTINE  DSCRT  - 


SUBROUTINE  KFILTCZ) 


C 

C  SUBROUTINE  TO  INCORPORATE  THE  KALMAN  FILTER  INTO  THE  LOOP  FOR 
C  NON-LINEAR  PERFORMANCE  ANALYSIS. 

C 

C**********tt*t*X:**.t*X:****:*x***:tX*****X**XXX***X**$****:*****.t**** 


COMMON /CONTRL/UNEW (4) , U0LDC4) , UCMD < 4 ) , UC0LDC4) , XOLDC 12) , 

1  XMQLD  C 4 )  ,  XM(4>  ,  MFLAG,  EVA  *  L)  , 

1  HC3, 4)  , PH IX (4,4)  ,  BD  <4,  3)  ,  QD  C  4 , 4)  ,  R  (3, 3)  ,  XHPC4)  ,  XHMC4.)  ,  K  C  4,3) 
REAL  A  WORK  C 4 ,  1  j  ,  BWQRK  (4,  1),  CWORK  <  3 ,  1)  ,  DWOPK  <3,1),  EWORK  <  4 ,  1 ) 
REAL  ZC3) 

CALL  MATML (FHIX,  XHF',  A  WORK,  4,4,  i> 

CALL  MATML (BD, UNEW , B WORK ,4,3,1) 

CALL  MATAD CAUORK , EWORK , XHM ,4,1) 

CALL  MATML (H, XHM, CWORK, 3, 4, 1 ) 

CALL  MATSBCZ, CWRK, DWCRK, 3, 1 > 

CALL  MATML ( K , DWORK , EWORK ,4,3, 1) 

CAL  L  MATAD  <  XHM , EWORK , XHP , 4 ,  1 ) 

C 

C  END  SUBROUTINE  K'T'ILT - 

C 


RETURN 


c 


Appendix  D:  Derivation  of  Nonlinear 
Thrust/Nozzle  Model 

The  following  is  a  derivation  of  the  STOL  F-15  air¬ 
craft  model  using  both  thrust  (throttle)  and  nozzle  deflec¬ 
tion  as  inputs  to  the  system.  As  will  be  seen  in  this 
derivation,  the  simultaneous  control  of  these  two  quantities 
introduces  a  nonlinearity  into  the  system  model.  Efforts 
were  made  to  design  a  constant-gain  controller  for  this 
system;  however,  instability  proved  to  be  a  severe  problem 
which  could  not  be  overcome.  To  allow  the  use  of  both 
throttle  and  thrust  vectoring  nozzles  in  flight  requires 
that  either  a  proper  linearization  of  this  model  be  derived 
or  that  extensions  to  the  constant-gain  CGT/PI/KF  be  intro¬ 
duced  to  compensate  for  this  nonlinearity. 

For  Figure  D.l,  the  X  direction  force,  Z  direction 
force,  and  longitudinal  moment  equations  become: 

1 

co. 

Fig.  D.l.  Diagram  of  Nozzle  Deflection 
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(D-2) 


T  sin  6..  ~  T6„ 
N  —  N 


*t6n 


(D-3) 


respectively,  where  m  is  the  aircraft  mass.  Also  note  that 
small  angle  approximations  are  made  in  Equations  (D-l) 
and  (D-2). 

Incorporating  (D-l)  and  (D-2)  into  the  standard 
perturbation  equations  of  motion  (in  dimensional  derivative 
form)  (19)  yields: 

u  =  -g0  cos  0  +  Xu  +  X  a  +  X.  Sc  +  -  +  X*  (D-4) 

ou  a  OgSmS^C 


w  -  u  q  =  -g0  sin  0  +Zu+Za+Z.&+Zq 
o^1  3  o  u  a  a  q^1 


+  Z6c6C  +  Z6s6S  +  i  6N 


(D-5 ) 


q  =  M  u  +  M_ u  +  M  a  +  M.a  +  M  q  +  M.  60 
^  u  Tu  a  a  q  <$g  S 


+ 


N 


(D-6) 


Now,  taking  the  Laplace  transform  of  (D-4)  to  (D-6) ,  again 
invoking  small  angle  approximations,  and  using  the  approxi¬ 
mation  that  the  acceleration  in  the  z  direction  is  equal  to 


193 


& 


r>  r, 


the  forward  velocity  times  the  derivative  of  the  angle  of 
attack: 


w  =  u  a 
o 


(D-7) 


Equations  (D-4)  to  (D— 6 )  become: 


su  =  -g0  +  Xu  +  X_  u  +  X  a  +  X*  6.  +  X-  6_  +  £  (D-8) 

u  Tu  a  Og  S  6^  C  m 


sau  -  u  q  =  -g00  +  2  u  +  Z  a  +  sZ.a  +  Z  q 

o  *  o  u  a  a  q 


+  Z<SS6S  +  Z6C(SC  +  ~ m" 


(D-9) 


sq  =  M  u  +  M_  u  +  M  a  +  M_  a  +  sM . a  +  M  q 
^  u  T  a  T  a  q 

u  a 

+  Ms  Ss  +  M  6  + 

S  °C  yy 


(D-10) 


Upon  rearranging  (D-9)  ,  it  becomes: 


u  q 
o 

geeo 

Z  u 
u 

Z  a 

+  a 

(u  -Z . ) 

o  a 

(u  -Z.) 

o  a 

(u  -Z . ) 

o  a 

'VV 

Z  q 

q  , 

Z  r  fip 
c  i 

Z,  ^  c 
6S  s 

+  T5n 

(u  -Z.) 
o  a 

(uo-Zd> 

(u  -Z.) 

o  a 

m(u  -Z. 

o  a 

(D-ll) 


In  state  space  form,  the  original  aircraft  equations  of 
motion  are  of  the  form: 
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(D-12) 


Using  the  following  first-order  lag  model  for  throttle 
dynamics  (20) 


(D-13 ) 


and  Equations  (D-8),  (D-10)  ,  and  (D-ll)  ,  the  nonlinear 
model  which  incorporates  both  thrust  and  nozzle  inputs, 
is  formed  as : 
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mm 
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Appendix  E:  Basic  Kalman  Filtering  Theory 

The  following  is  a  presentation  of  steady-state 
constant-gain  Kalman  filter  theory.  This  is  intended  to 
acquaint  the  reader  with  the  simple  form  of  filter  which 
was  used  in  the  controller  presented  in  Chapter  V.  For  a 
complete  treatment  of  this  topic,  see  Reference  11. 

The  Kalman  filter  is  an  optimal  recursive  algorithm 
which  is  used  to  produce  estimates  of  system  states  based 
on  partial,  noise-corrupted  measurements  of  the  form: 

z(t±)  =  Hx  (t±)  +  v(t±)  (E-l) 

where  H  is  the  system  measurement  matrix  and  v  is  a  zero- 
mean  white  Gaussian  noise  with  associated  covariance 

E{v(ti)vT(t:j)  }  =  R  6±j  (E-2) 

The  mean  and  covariance  of  the  states  after  a  measurement 
are  defined  conditionally  via  Bayes  rule  (11:18)  based  on 
the  systems  measurement  history,  Z (t^_1) ,  to  be 

x(ti_1+)  =  E  {  x(ti_1)  |Z(ti_i)  =  Zi_1}  (E-3) 

T 

P(ti_1+)  =  E  {  [x(ti_1)-x(ti_1+)  ]  [x(ti_1)-x(ti_]+)  ]  | 

Z(ti-1)  =  Zi-1}  (E“4) 
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Once  the  update  of  the  state  estimate  and  covariance  is 
accomplished,  these  quantities  are  propagated  to  the  next 
sample  time  to  attain  the  conditional  mean  and  covariance 
at  that  time,  before  measurement  update,  defined  as 


x(t^  )  =  E{x(ti) j  Z (ti_1)  =  Zi_1} 


(E-5) 


-»  ,T, 


P(ti  )  =  E{ [x(ti)-x(ti  )] [x(ti)-x(ti  ) ] A | Z ( t±_1)  =  Zi_1} 

(E-6) 


Based  on  the  above  equations,  the  Kalman  filter  equations 
are  shown  to  be  (11): 


)  =  lx(ti_1  )  +  Bd  uft^) 


(E-7 ) 


Pltf)  =  +  Gd  Qd  Gd+ 


(E-8) 


K(t±  )  =  P(ti')HT[H  P(t~)HT+R]_1 


(E-9) 


x(t±  )  =  x(ti  )  +  K(ti)  [Zi-Hx(ti  )] 


(E-10 ) 


P(t±  )  =  PCtj^  )  -  K(ti)  HP(t,  ) 


(E-ll ) 


It  is  this  form  of  the  Kalman  filter  which  is  used  to 
replace  the  assumption  of  full  state  availability  with 
estimates  produced  as  in  Equation  (E-10)  for  the  designs 
presented  in  Chapter  V. 
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Appendix  F:  Plotted  Data  for  Section  5 . 7 


Introduction 

The  following  plots  correspond  to  the  robustness 
analysis  conducted  in  the  course  of  this  thesis  (see  Sec¬ 
tion  5.7).  Each  plot  contains  the  time  histories  of  the 
pitch  angle,  flight  path,  and  pitch  rate  channels  along 
with  throttle,  canard,  and  stabilator  deflections  over  a 
6 -second  period. 
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Aircraft  Response  with  Actuators  and^Kalman 
Filter  in  the  Loop/Control  Based  on  x(t^  )/ 
Anti-Windup  Compensation/40  Fold  Increase 
in  Measurement  Noise 

a.  Aircraft  responses;  b.  Control  deflections 
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Aircraft  Response  with  Actuators,  Position 
Limits,  and  K_alman  Filter  in  the  Loop/Control 
Based  on  x{tT)/High  Level  Noise  (q=0.8)  in 
Pitch  Rate  and  Angle  of  Attack  Channels 
a.  Aircraft  responses;  b.  Control  deflections 
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Aircraft  Response  with  Actuators,  Position  Li 
and  _Kalman  Filter  in  the  Loop/Control  Based  o 
x(t.”)/High  Level  Noise  (q=0.8)  in  Pitch  Rate 
and  Angle  of  Attack  Channels/LTR  Tuning  with 
Loop  Broken  at  the  Input 

a.  Aircraft  responses;  b.  Control  deflections 
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Appendix  G:  Notes  on  LTR  Technique  for  Application 

to  LQG/PI/KF  System 

In  this  appendix,  some  ideas  which  have  been 
generated  concerning  LTR  tuning  and  its  application  to 
the  designs  used  in  this  thesis  will  be  presented.  No 
definite  conclusions  will  be  presented  in  this  appendix; 
however,  some  suggestions  which  may  be  worth  pursuing  will 
be  introduced. 

At  the  onset  of  using  the  LTR  technique  in  this 
thesis  effort.  Equation  (4-4)  was  applied  in  a  rather  blind 
fashion.  When  results  showed  no  improvement  in  the  system 
robustness,  the  assumption  was  made  that,  perhaps,  the  LTR 
tuning  technique  was  not  applicable  to  the  LQG/PI/KF  con¬ 
troller  structure  which  was  implemented  in  the  designs  pre¬ 
sented  in  Chapter  V.  Following  the  apparent  failure  of  the 
LTR  technique,  the  ad-hoc  C-tuning  method  was  attempted  and 
system  robustness  was  greatly  enhanced.  After  a  more 
detailed  investigation  of  the  LTR  method  (G1:G2) ,  three 
conclusions  have  been  reached  concerning  the  above-mentioned 
results: 

1.  The  fact  that  LTR  tuning  based  on  Equation  (4-4) 
did  not  improve  system  robustness  simply  implies  that  the 
system  robustness  characteristics  for  the  loop  broken  at 
the  input  are  not  desirable  in  the  full  state  case. 
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Therefore,  as  q  was  increased,  the  filter-based  system 
asymptotically  approached  what  could  have  been  poor  robust¬ 
ness  characteristics  in  the  non-filter-based  system. 

2.  The  favorable  results  obtained  using  C-tuning 
is  completely  reasonable  under  existing  LTR  theory.  As 
stated  in  Reference  G.l,  robustness  enhancement  can  be 
obtained  at  any  arbitrary  break  in  the  controller  loop  by 
injecting  white  noise  into  that  point  in  the  system.  There 
fore,  the  C-tuning  roughly  corresponds  to  LTR  tuning 
applied  with  the  system  broken  at  the  output.  Based  on  the 
preceding,  an  explanation  for  the  success  of  the  LTR  method 
applied  at  the  output  instead  of  the  input  of  the  system 
indicates  that  the  full  state  controller  displays  better 
robustness  characteristics  in  the  variables  of  interest  to 
us  in  this  application  than  the  system  broken  at  the  input, 
and  it  is  these  loop  transmission  characteristics  that  are 
recovered. 

3.  The  above  assumptions  should  be  investigated 
using  computer  analysis  of  the  frequency  response  of  the 
system  broken  at  both  the  input  and  output  to  verify  that 
indeed  the  injection  of  white  noise  into  the  outputs  of  the 
design  model  is  the  proper  form  of  the  LTR  tuning  technique 
to  be  used  in  this  particular  flight  control  design.  Once 
the  proper  point  to  regain  system  loop  transmission  robust¬ 
ness  is  established  (perhaps  not  even  the  input  or  the 
output  points,  but  some  other  point  in  the  loop) ,  the  LTR 


technique  can  be  applied  and  structured  singular  value 
analysis  could  be  used  to  establish  the  amount  of  recovery 
which  is  achieved  as  q  is  increased. 

Based  on  the  fact  that  what  is  referred  to  as 
C-tuning  is  really  LTR  tuning,  it  has  been  shown  that,  in 
fact,  LTR  tuning  is  applicable  to  a  CGT/PI/KF  control  struc¬ 
ture.  The  problem  which  remains  to  be  solved  is  the  fore- 
mentioned  task  of  determining  the  proper  point  in  the  loop 
to  break  the  loop,  or  at  least  to  show  that  the  loop  trans¬ 
mission  robustness  characteristics  of  the  system  broken  at 
the  output  do  indeed  display  favorable  frequency  response 
characteristics  (i.e.,  bandwidth,  crossover  frequency 
slope,  etc.). 
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